Untitled

 avatar
unknown
plain_text
16 days ago
1.1 kB
4
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