27 lines
752 B
Python
27 lines
752 B
Python
from sr.robot3 import Robot
|
|
|
|
robot = Robot()
|
|
|
|
robot.motor_board.motors[0].power = 1
|
|
robot.motor_board.motors[1].power = 1
|
|
|
|
# measure the distance of the right ultrasound sensor
|
|
# pin 6 is the trigger pin, pin 7 is the echo pin
|
|
distance = robot.arduino.ultrasound_measure(6, 7)
|
|
print(f"Right ultrasound distance: {distance / 1000} meters")
|
|
|
|
# motor board, channel 0 to half power forward
|
|
robot.motor_board.motors[0].power = 0.5
|
|
|
|
# motor board, channel 1 to half power forward,
|
|
robot.motor_board.motors[1].power = 0.5
|
|
# minimal time has passed at this point,
|
|
# so the robot will appear to move forward instead of turning
|
|
|
|
# sleep for 2 second
|
|
robot.sleep(2)
|
|
|
|
# stop both motors
|
|
robot.motor_board.motors[0].power = 0
|
|
robot.motor_board.motors[1].power = 0
|