Untitled
unknown
plain_text
8 months ago
1.1 kB
7
Indexable
def draw_T(turtle_name, turtle_api):
# Rysowanie litery T
vel = Twist()
vel.linear.x = 2 # Prędkość do ruchu
# Rysowanie pionowej linii
for i in range(10):
pose = turtle_api.getPose(turtle_name)
turtle_api.setPose(turtle_name, turtlesim.msg.Pose(x=pose.x, y=pose.y + 1, theta=pose.theta)) # Rysowanie w górę
rospy.sleep(0.1)
# Teraz rysujemy poziomą linie
vel.linear.x = 0 # Zatrzymujemy żółwia na chwilę, żeby rysować poziomo
turtle_api.setVel(turtle_name, vel)
# Obrót o 90° w prawo
turtle_api.setPose(turtle_name, turtlesim.msg.Pose(x=pose.x, y=pose.y, theta=math.pi / 2)) # Obrót o 90 stopni
# Rysowanie poziomej linii
vel.linear.x = 2 # Prędkość rysowania poziomej linii
turtle_api.setVel(turtle_name, vel)
for i in range(5): # Narysuj linię poziomą
pose = turtle_api.getPose(turtle_name)
turtle_api.setPose(turtle_name, turtlesim.msg.Pose(x=pose.x + 1, y=pose.y, theta=pose.theta)) # Rysowanie poziomo
rospy.sleep(0.1)Editor is loading...
Leave a Comment