mirror of
https://github.com/orbbec/OrbbecSDK_ROS2.git
synced 2026-10-04 12:07:46 +08:00
catch error when ctrl camera
This commit is contained in:
@@ -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__":
|
||||
|
||||
Reference in New Issue
Block a user