summaryrefslogtreecommitdiff
path: root/robot/problems/introduction/followline/naloga12_followLine.py
blob: 347e89e8b0eb3f71d686c5e2026e60ea24addb88 (plain)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
#!/usr/bin/python
# coding=utf-8

print( """
Naloga 12:
   Robot naj 10 sekund sledi crni crti na beli podlagi; pri tem naj si pomaga z barvnim senzorjem.
""")
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( 'color' )

start = time.time()
# CALIBRATION
# print 'black', robot.color_sensor_measure('reflected_light_intensity')
# print "move to white"
# time.sleep(5)
# print 'white', robot.color_sensor_measure('reflected_light_intensity')
while time.time()-start < 10:
    if robot.color_sensor_measure('reflected_light_intensity') < 30:
        L, R = 0, 20
    else:
        L, R = 20, 0
    robot.move_tank( 'on', lr_power=[L,R])
robot.move_tank( 'off' )