diff --git a/lesson_04/alex_move.py b/lesson_04/alex_move.py new file mode 100644 index 0000000000000000000000000000000000000000..61ced8dac4e4ebab8593a5e6c79bcfe1140b3c72 --- /dev/null +++ b/lesson_04/alex_move.py @@ -0,0 +1,46 @@ +import rclpy +from rclpy.node import Node +from rclpy.duration import Duration + +from geometry_msgs.msg import Twist +import math + + +class RurMover(Node): + def __init__(self): + super().__init__('minimal_publisher') + self.publisher_twist = self.create_publisher(Twist, 'turtle1/cmd_vel', 10) + self.main() + + def publish_twist(self, linear, angular): + msg = Twist() + msg.linear.x = float(linear) + msg.angular.z = math.radians(float(angular)) + self.publisher_twist.publish(msg) + self.get_clock().sleep_for(Duration(seconds=1.0)) + + def main(self): + self.publish_twist(0, 60.0) + self.publish_twist(3, 0.0) + self.publish_twist(0, -120.0) + self.publish_twist(3, 0.0) + self.publish_twist(0, -180.0) + self.publish_twist(1.7, 0.0) + self.publish_twist(0, 60.0) + self.publish_twist(1.3, 0.0) + self.publish_twist(0, 60.0) + self.publish_twist(1.7, 0.0) + + +def main(args=None): + rclpy.init(args=args) + + mover = RurMover() + + rclpy.spin(mover) + + mover.destroy_node() + rclpy.shutdown() + +if __name__ == '__main__': + main() \ No newline at end of file diff --git a/setup.py b/setup.py index 9e5dc57746bf472f3cb9ce74d49c8f79078942e7..58d0062686f50d36e183ef6fd72761d690604743 100644 --- a/setup.py +++ b/setup.py @@ -26,6 +26,7 @@ setup( 'step_1 = lesson_04.step_1:main', 'step_2 = lesson_04.step_2:main', 'step_3 = lesson_04.step_3:main', + 'alex_move = lesson_04.alex_move:main', 'square = lesson_04.square:main', 'mover = lesson_04.mover:main', ],