- OS : Ubuntu 22.04
- ROS 2 Humble
- Gazebo 11
1. 하나의 노드에서 두 개 이상의 토픽 다루기
1. 코드 수정
import rclpy as rp
from rclpy.node import Node
from my_first_package_msgs.msg import CmdAndPoseVel
from geometry_msgs.msg import Twist
from turtlesim.msg import Pose
class CmdAndPose(Node):
def __init__(self):
super().__init__('turtle_cmd_pose')
self.sub_pose = self.create_subscription(
Pose, '/turtle1/pose', self.callback_pose, 10)
self.sub_pose = self.create_subscription(
Twist, '/turtle1/cmd_vel', self.callback_cmd, 10)
self.cmd_pose = CmdAndPoseVel()
def callback_pose(self, msg):
self.cmd_pose.pose_x = msg.x
self.cmd_pose.pose_y = msg.y
self.cmd_pose.linear_vel = msg.linear_velocity
self.cmd_pose.angular_vel = msg.angular_velocity
def callback_cmd(self, msg):
self.cmd_pose.cmd_vel_linear = msg.linear.x
self.cmd_pose.cmd_vel_angular = msg.angular.z
print(self.cmd_pose)
def main(args=None):
rp.init(args=args)
turtle_cmd_pose_node = CmdAndPose()
rp.spin(turtle_cmd_pose_node)
turtle_cmd_pose_node.destroy_node()
rp.shutdown()
if __name__ == '__main__':
main()
- cmd_vel 토픽 구독을 위해 init 부분을 수정
2. 빌드, 환경 부르기

3. 실행

4. rqt_graph

- turtlesim_publisher가 cmd_vel을 쏘고 turtlesim으로 들어감
- turtle_cmd_pose가 cmd_vel과 pose 구독