38 lines
1.4 KiB
Python
38 lines
1.4 KiB
Python
import sys
|
|
from os import path
|
|
sys.path.append(path.abspath(path.join(path.dirname(__file__), '..')))
|
|
|
|
from LocalParticipant import LocalParticipant
|
|
from Things.DifferentialDrive import DifferentialDrive
|
|
from Things.TouchSensor import TouchSensor
|
|
import time
|
|
|
|
# Create a local participant for handling communcation
|
|
# using default settings (UDP communciation over port 7681)
|
|
participant = LocalParticipant(port=7681, local_port=7682)
|
|
# The robot's propulsion is a differential drive
|
|
bb2b = DifferentialDrive(participant)
|
|
bb2b.model_url = "https://passer.life/extras/ant1_transparent.png"
|
|
|
|
# It has a touch sensor at the front left of the roboid
|
|
touch_left = TouchSensor(parent=bb2b)
|
|
# and other one on the right
|
|
touch_right = TouchSensor(parent=bb2b)
|
|
|
|
# Do forever:
|
|
while True:
|
|
# The left wheel turns forward when nothing is touched on the right side
|
|
# and turn backward when the roboid hits something on the right
|
|
wheel_speed_left = -600 if touch_right.touched_somthing else 600
|
|
# The right wheel does the same, but instead is controlled by
|
|
# touches on the left side
|
|
wheel_speed_right = -600 if touch_left.touched_somthing else 600
|
|
# When both sides are touching something, both wheels will turn backward
|
|
# and the roboid will move backwards
|
|
bb2b.SetWheelVelocity(wheel_speed_left, wheel_speed_right)
|
|
|
|
# Update the roboid state
|
|
participant.Update()
|
|
# and sleep for 100ms
|
|
time.sleep(100)
|