利用颜色的HSV识别不同颜色的垃圾和垃圾桶,机器人在不同的状态下检测是否有垃圾,捡完垃圾后,转动头部寻找垃圾桶,如果前方没有找到垃圾桶就执行转身,寻找身后的垃圾桶。找到垃圾桶后执行丢垃圾动作。 一、道具准备 用3个颜色不同的纸团代替不同的垃圾,用蓝色纸团来代替可回收物,绿色纸团来代替厨余垃圾,用红色纸团来代替有害垃圾。 (用纸团代替不同类别垃圾)
用蓝色桶来代替可回收收集容器,用绿色桶来代替厨余垃圾收集容器,用红色桶来代替有害垃圾收集容器。 (用桶代替收集容器)
二、程序编辑
1、识别“垃圾” 1)确定颜色顺序,案例中以红、蓝、绿三个顺序依次拾取 2)机器人在站立状态下看到“垃圾”的时候,说明垃圾离机器人较远,机器人可以快走前进。 4)当微弯腰状态已经不能识别垃圾,进入大弯腰状态,这个状态下说明机器人离垃圾已经非常近了,可以执行捡取动作。 2、扔垃圾 在拾取垃圾后,机器人面前已经没有垃圾,机器人旋转头部检测,如果前面都没有目标色机器人进行转身,寻找身后的垃圾桶。 机器人转身就能识别到目标垃圾桶,因为垃圾桶比较高,所以只做二个级别的检测就可以了,站立检测是否有目标色,然后前进,微弯腰检测目标色。 总程序(蓝色和绿色程序与红色程序相同) |