From 1e5d42ba53ea0c631dbc6f21887839c91571ebca Mon Sep 17 00:00:00 2001
From: =?UTF-8?q?Jure=20=C5=BDabkar?= <jure.zabkar@fri.uni-lj.si>
Date: Tue, 13 Oct 2015 12:24:41 +0200
Subject: Uvodne vaje za robotiko

---
 .../introduction/rotateback/naloga11_rotateBack.py | 48 ++++++++++++++++++++++
 1 file changed, 48 insertions(+)
 create mode 100644 robot/problems/introduction/rotateback/naloga11_rotateBack.py

(limited to 'robot/problems/introduction/rotateback/naloga11_rotateBack.py')

diff --git a/robot/problems/introduction/rotateback/naloga11_rotateBack.py b/robot/problems/introduction/rotateback/naloga11_rotateBack.py
new file mode 100644
index 0000000..0bab735
--- /dev/null
+++ b/robot/problems/introduction/rotateback/naloga11_rotateBack.py
@@ -0,0 +1,48 @@
+#!/usr/bin/python
+# coding=utf-8
+
+print ("""
+Naloga 11: 
+""")
+import sys
+sys.path.append('/home/user/codeq')
+import time
+from ev3dev import *
+from mindstorms_widgets import mindstorms_widgets
+
+def sgn(x):
+    return -1 if x<0 else (1 if x>0 else 0)
+
+robot = mindstorms_widgets()
+robot.connect_motor( 'left' )
+robot.connect_motor( 'right' )
+robot.connect_sensor( 'gyro' )
+robot.connect_sensor( 'touch' )
+
+smer = hitrost = 0
+robot.reset_gyro()
+robot.gyro_set_mode( 'angle' )
+prev_smer = -1
+while 1:
+    smer = robot.gyro_sensor_measure()
+    if smer!=prev_smer:
+        print ("Kot:", smer)
+        prev_smer = smer
+    
+    if robot.touch_sensor_measure():
+        robot.reset_gyro()
+        print ( robot.gyro_sensor_measure() )
+    
+    if abs(smer) < 10:
+        hitrost = 10*sgn(smer)
+    else:
+        if abs(smer) > 100:
+            hitrost = 100*sgn(smer)
+        else:
+            hitrost = smer
+    
+    if abs(smer) > 1:
+        L, R = -hitrost, hitrost
+    else:
+        L = R = 0
+    robot.move_tank('on', lr_power=[L,R])
-- 
cgit v1.2.1