From 1e5d42ba53ea0c631dbc6f21887839c91571ebca Mon Sep 17 00:00:00 2001 From: =?UTF-8?q?Jure=20=C5=BDabkar?= Date: Tue, 13 Oct 2015 12:24:41 +0200 Subject: Uvodne vaje za robotiko --- .../introduction/gyrosquare/naloga08_gyroSquare.py | 33 ++++++++++++++++++++++ 1 file changed, 33 insertions(+) create mode 100644 robot/problems/introduction/gyrosquare/naloga08_gyroSquare.py (limited to 'robot/problems/introduction/gyrosquare/naloga08_gyroSquare.py') diff --git a/robot/problems/introduction/gyrosquare/naloga08_gyroSquare.py b/robot/problems/introduction/gyrosquare/naloga08_gyroSquare.py new file mode 100644 index 0000000..ec0dd2f --- /dev/null +++ b/robot/problems/introduction/gyrosquare/naloga08_gyroSquare.py @@ -0,0 +1,33 @@ +#!/usr/bin/python +# coding=utf-8 + +print (""" +Naloga 8: + Robot naj prevozi kvadrat s stranico 20 cm; pri tem naj si pomaga z ziroskopom. +""") +import sys +sys.path.append('/home/user/codeq') +import time +from ev3dev import * +from mindstorms_widgets import mindstorms_widgets + +robot = mindstorms_widgets() +robot.connect_motor( 'left' ) +robot.connect_motor( 'right' ) +robot.connect_sensor( 'gyro' ) + +robot.gyro_set_mode( 'angle' ) +robot.reset_gyro() + +power = 20 +def forward_and_turnRight(power, angle): + robot.move_steering( 'on_for_seconds', direction=0, power=power, seconds=2 ) + robot.move_tank( 'on', lr_power=[power,-power] ) + while robot.gyro_sensor_measure( 'angle' ) < angle: + pass + robot.move_tank( 'off' ) + +forward_and_turnRight(power, 89) +forward_and_turnRight(power, 179) +forward_and_turnRight(power, 269) +forward_and_turnRight(power, 359) -- cgit v1.2.1