要将自己编写的代码添加到OriginBot中，可按以下步骤操作： ### 1. 开发环境准备 确保已经在OriginBot上正确安装了ROS2。可以使用如下命令进行安装： ```bash wget http://fishros.com/install -O fishros && . fishros ``` 根据提示选择数字1，进入ROS2的安装流程，安装完成后进入验证阶段。分别打开三个终端，依次输入相应命令（具体命令在引用中未详细给出） [^2]。 ### 2. 代码编写与组织 编写自己的代码时，需遵循ROS2的节点编程规范。例如，若要实现人脸识别功能，可参考以下代码结构： ```python import rclpy from rclpy.node import Node import cv2 class FaceDetectionNode(Node): def __init__(self): super().__init__('face_detection_node') # 指定已经训练好的人脸分类器的路径 self.classifier_path = "haarcascade_frontalface_default.xml" self.face_cascade = cv2.CascadeClassifier(self.classifier_path) # 后续可添加图像订阅和发布的相关代码 def detect_faces(self, image): gray = cv2.cvtColor(image, cv2.COLOR_BGR2GRAY) faces = self.face_cascade.detectMultiScale(gray, 1.3, 5) for (x, y, w, h) in faces: cv2.rectangle(image, (x, y), (x+w, y+h), (255, 0, 0), 2) return image def main(args=None): rclpy.init(args=args) face_detection_node = FaceDetectionNode() rclpy.spin(face_detection_node) face_detection_node.destroy_node() rclpy.shutdown() if __name__ == '__main__': main() ``` 上述代码中，`rclpy.init(args=args)` 和 `rclpy.shutdown()` 分别用于初始化和关闭ROS2节点 [^1]。 ### 3. 创建工作空间和功能包 在OriginBot上创建一个工作空间，例如 `originbot_ws`： ```bash mkdir -p originbot_ws/src cd originbot_ws/src ``` 然后创建一个新的功能包，例如 `my_face_detection_pkg`： ```bash ros2 pkg create --build-type ament_python my_face_detection_pkg --dependencies rclpy cv_bridge sensor_msgs image_transport ``` ### 4. 将代码添加到功能包 将编写好的代码文件（如上述的人脸识别代码）复制到 `originbot_ws/src/my_face_detection_pkg/my_face_detection_pkg` 目录下。 ### 5. 配置 `setup.py` 文件 打开 `originbot_ws/src/my_face_detection_pkg/setup.py` 文件，在 `entry_points` 部分添加以下内容： ```python entry_points={ 'console_scripts': [ 'face_detection_node = my_face_detection_pkg.face_detection_node:main', ], }, ``` ### 6. 编译和运行 回到工作空间根目录，编译功能包： ```bash cd originbot_ws colcon build --packages-select my_face_detection_pkg ``` 编译完成后，设置环境变量： ```bash source install/setup.bash ``` 最后运行节点： ```bash ros2 run my_face_detection_pkg face_detection_node ```