summaryrefslogtreecommitdiff
path: root/robot/problems/introduction/wall1m/naloga06_wall1m_testing.py
blob: b2904c53cc80bfcced643f6813e65416e5fec6c8 (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
32
33
34
35
36
37
38
39
40
41
42
#!/usr/bin/python

print ("""
Naloga 6:
    Robota postavi pred zid, tako da bo od njega oddaljen vsaj 1 m; vmes naj ne bo ovir.
    Napisi program, s katerim bo robot vozil naravnost proti zidu z 80% mocjo.
    Na razdalji 50 cm od zida naj robot zmanjsa hitrost na 20%, na razdalji 20 cm od zida pa naj se ustavi.
""")
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' )

mw=True

if mw:
	robot.connect_sensor( 'ultrasonic' )
	robot.move_steering( 'on', power=80 )
	while robot.ultrasonic_sensor_measure( 'distance-cm' ) > 500:
		print(robot.ultrasonic_sensor_measure( 'distance-cm' ) )
	print(robot.ultrasonic_sensor_measure( 'distance-cm' ) )
	robot.move_steering( 'on', power=20 )
	while robot.ultrasonic_sensor_measure( 'distance-cm' ) > 200:
		print(robot.ultrasonic_sensor_measure( 'distance-cm' ) )
	robot.move_steering( 'off' )
else:
	us = ultrasonic_sensor()
	assert us.connected
	us.mode = 'US-DIST-CM' # Continuous measurement of distance (0-2550 mm)
	robot.move_steering( 'on', power=80 )
	while us.value()>500:
		print( us.value() )
	print( us.value() )
	robot.move_steering( 'on', power=20 )
	while us.value()>200:
		print( us.value() )
	robot.move_steering( 'off' )