catch error when ctrl camera

This commit is contained in:
Joe Dong
2022-06-07 18:09:17 +08:00
parent 669755bf63
commit b51f8bf2b3
10 changed files with 298 additions and 109 deletions
+8 -8
View File
@@ -1,18 +1,14 @@
import imp
from orbbec_camera_msgs.msg import Extrinsics
from rclpy.node import Node
from rclpy.qos import qos_profile_system_default
import rclpy
class EchoExtrinsics(Node):
class TestNode(Node):
def __init__(self):
super().__init__("echo_extrinsics")
super().__init__("test_node")
self.subscription = self.create_subscription(
Extrinsics,
"/camera/extrinsics",
self.callback,
qos_profile_system_default
Extrinsics, "/camera/extrinsics", self.callback, qos_profile_system_default
)
def callback(self, msg: Extrinsics):
@@ -26,7 +22,11 @@ class EchoExtrinsics(Node):
def main(args=None):
rclpy.init()
rclpy.init(args=args)
test_node = TestNode()
rclpy.spin(test_node)
test_node.destry_node()
rclpy.shutdown()
if __name__ == "__main__":