# -*- coding: utf-8 -*- import cv2 import numpy as np # 定义要识别的颜色范围 lower_color = np.array([85, 90, 28]) upper_color = np.array([121, 226, 76]) # 初始化摄像头 cap = cv2.VideoCapture(0) while True: # 获取当前帧 ret, frame = cap.read() # 转换颜色空间 hsv = cv2.cvtColor(frame, cv2.COLOR_BGR2HSV) # 根据颜色范围进行二值化 mask = cv2.inRange(hsv, lower_color, upper_color) # 寻找轮廓 _,contours, _ = cv2.findContours(mask, cv2.RETR_TREE, cv2.CHAIN_APPROX_SIMPLE) # 遍历轮廓 for contour in contours: # 计算轮廓面积 area = cv2.contourArea(contour) # 忽略面积较小的轮廓 if area < 100: continue # 计算轮廓的外接矩形 x, y, w, h = cv2.boundingRect(contour) # 在原图上绘制外接矩形 cv2.rectangle(frame, (x, y), (x + w, y + h), (0, 255, 0), 2) # 显示图像 cv2.imshow('frame', frame) # 按下 q 键退出程序 if cv2.waitKey(1) & 0xFF == ord('q'): break # 释放摄像头并关闭窗口 cap.release() cv2.destroyAllWindows() 这段代码帮我改成ROS订阅摄像头
时间: 2023-12-12 16:05:50 浏览: 92
好的,我可以帮你把这段代码改为ROS订阅摄像头的形式。需要注意的是,需要在ROS环境下使用cv_bridge库来转换ROS图像格式和OpenCV图像格式。以下是改写后的代码:
```python
#!/usr/bin/env python
# -*- coding: utf-8 -*-
import cv2
import numpy as np
import rospy
from sensor_msgs.msg import Image
from cv_bridge import CvBridge, CvBridgeError
# 定义要识别的颜色范围
lower_color = np.array([85, 90, 28])
upper_color = np.array([121, 226, 76])
# 初始化cv_bridge
bridge = CvBridge()
# 定义回调函数,处理订阅到的图像
def image_callback(msg):
# 将ROS图像格式转换为OpenCV图像格式
try:
cv_image = bridge.imgmsg_to_cv2(msg, 'bgr8')
except CvBridgeError as e:
print(e)
return
# 转换颜色空间
hsv = cv2.cvtColor(cv_image, cv2.COLOR_BGR2HSV)
# 根据颜色范围进行二值化
mask = cv2.inRange(hsv, lower_color, upper_color)
# 寻找轮廓
_, contours, _ = cv2.findContours(mask, cv2.RETR_TREE, cv2.CHAIN_APPROX_SIMPLE)
# 遍历轮廓
for contour in contours:
# 计算轮廓面积
area = cv2.contourArea(contour)
# 忽略面积较小的轮廓
if area < 100:
continue
# 计算轮廓的外接矩形
x, y, w, h = cv2.boundingRect(contour)
# 在原图上绘制外接矩形
cv2.rectangle(cv_image, (x, y), (x + w, y + h), (0, 255, 0), 2)
# 显示图像
cv2.imshow('frame', cv_image)
cv2.waitKey(1)
# 初始化节点
rospy.init_node('color_detection')
# 订阅摄像头图像
image_sub = rospy.Subscriber('/camera/image_raw', Image, image_callback)
# 进入循环
rospy.spin()
# 关闭窗口
cv2.destroyAllWindows()
```
你可以将这段代码保存为一个ROS节点,并在运行前确保已经启动了摄像头节点。运行这个节点后,它将会订阅摄像头图像,并且在接收到图像后进行颜色识别和边框绘制,最后通过OpenCV显示出来。