In this post, I will show you how to give your wheeled robot the ability to follow a colored ball. You will get your first taste of computer vision and image processing.
Here are the requirements:
- Build a wheeled robot powered by Raspberry Pi that must identify and follow a yellow rubber ball using OpenCV, a library of programming functions for real-time computer vision and image processing.
You Will Need
The following components are used in this project. You will need:
- Wheeled Robot
- Yellow Rubber Ball (available from eBay)
- Raspberry Pi Camera Module V2-8 (Standard)
- 2×2 Lego Brick (available from eBay)
- VELCRO Brand Thin Clear Fasteners
Connecting the Raspberry Pi Camera Module
Make sure the Raspberry Pi is turned OFF.
Open the Camera Serial Interface on the Raspberry Pi. It is located next to the 3.5mm audio jack. Pull it upwards delicately from either side.
Insert the ribbon of the camera module into the Camera Serial Interface. Make sure the silver contacts face away from the 3.5mm audio jack.
Hold the ribbon in place while pushing down on the Camera Serial Interface port. Make sure it is closed.
Mount the camera to the front of the robot.
Power up Raspberry Pi.
Open up a configuration window:
Interfacing Options –> ENTER –> Camera –> ENTER –> Yes
The camera is enabled.
Now, we need to set the resolution.
Advanced Options –> Resolution –> DMT Mode 82 1920×1080 60Hz 16: 9 –> ENTER –> Finish
Restart the Raspberry Pi by typing the following in a terminal window.
Testing the Raspberry Pi Camera Module.
We need to take a test photo with our newly installed camera module.
Open a terminal window. Type the following command:
raspistill -o test_photo.jpg
Go to your home directory to see if the test photo is there. Here is the photo that mine took (back of my head).
Setting Up Object Tracking
Now, we need to configure our system so the robot can track a yellow rubber ball.
Download the dependencies for OpenCV, a library of programming functions for real-time computer vision and image processing.
Type the following command into a terminal window:
sudo apt-get update
sudo apt-get install libblas-dev libatlas-base-dev libjasper-dev libqtgui4 libqt4-test
Y –> ENTER.
Wait a few moments while everything installs.
Install OpenCV using pip.
sudo pip3 install opencv-python
Install the PiCamera library.
sudo apt-get install python3-picamera
Determining the HSV Value of the Yellow Ball
We need to select an appropriate HSV (hue, saturation, value) value for the yellow ball. HSV is an alternative color representation that is frequently used instead of the RGB (Red Green Blue) color model I covered in my light and sound wheeled robot post.
Here is the HSV table.
Since the ball is yellow, I’ll choose 60 as my starting number.
Open IDLE in your Raspberry Pi, and create a new file in your robot directory. Name it color_tester.py.
Here is the code for the program:
# import the necessary packages from picamera.array import PiRGBArray from picamera import PiCamera import time import cv2 import numpy as np # initialize the camera and grab a reference to the raw camera capture camera = PiCamera() camera.resolution = (640, 480) camera.framerate = 32 rawCapture = PiRGBArray(camera, size=(640, 480)) while True: while True: try: hue_value = int(input("Hue value between 10 and 245: ")) if (hue_value < 10) or (hue_value > 245): raise ValueError except ValueError: print("That isn't an integer between 10 and 245, try again") else: break lower_red = np.array([hue_value-10,100,100]) upper_red = np.array([hue_value+10, 255, 255]) for frame in camera.capture_continuous(rawCapture, format="bgr", use_video_port=True): image = frame.array hsv = cv2.cvtColor(image, cv2.COLOR_BGR2HSV) color_mask = cv2.inRange(hsv, lower_red, upper_red) result = cv2.bitwise_and(image, image, mask= color_mask) cv2.imshow("Camera Output", image) cv2.imshow("HSV", hsv) cv2.imshow("Color Mask", color_mask) cv2.imshow("Final Result", result) rawCapture.truncate(0) k = cv2.waitKey(5) #& 0xFF if "q" == chr(k & 255): break
Place your ball about a yard in front of the camera.
Run the newly created program.
You will see four windows.
- Window 1. RGB representation
- Window 2: HSV representation
- Window 3: Show the portions of the frame that match a hue value of 60.
- Window 4: Entire frame minus all portions that do NOT have a 60 hue value.
To try a different hue value, select any of the four windows above. Press Q to halt the output of the video.
Go to the terminal window, and try a new hue valve. I’ll try 29 this time. It worked!
You keep trying different numbers until Window 4 shows mostly your ball and nothing else. Be patient and try LOTS of numbers.
Write down the hue value you ended up with on a sheet of paper.
Press CTRL-C in the terminal window to stop running color_tester.py.
Coding the Ball-Following Program
Open IDLE. Create a new file in your robot directory named:
Here is the code (Credit to Matt Timmons-Brown, the author of a really good book on Raspberry Pi robotics: (Learn Robotics with Raspberry Pi):
from picamera.array import PiRGBArray from picamera import PiCamera import cv2 import numpy as np import gpiozero camera = PiCamera() image_width = 640 image_height = 480 camera.resolution = (image_width, image_height) camera.framerate = 32 rawCapture = PiRGBArray(camera, size=(image_width, image_height)) center_image_x = image_width / 2 center_image_y = image_height / 2 minimum_area = 250 maximum_area = 100000 robot = gpiozero.Robot(left=(22,27), right=(17,18)) forward_speed = 1.0 turn_speed = 0.8 HUE_VAL = 29 lower_color = np.array([HUE_VAL-10,100,100]) upper_color = np.array([HUE_VAL+10, 255, 255]) for frame in camera.capture_continuous(rawCapture, format="bgr", use_video_port=True): image = frame.array hsv = cv2.cvtColor(image, cv2.COLOR_BGR2HSV) color_mask = cv2.inRange(hsv, lower_color, upper_color) image2, countours, hierarchy = cv2.findContours(color_mask, cv2.RETR_LIST, cv2.CHAIN_APPROX_SIMPLE) object_area = 0 object_x = 0 object_y = 0 for contour in countours: x, y, width, height = cv2.boundingRect(contour) found_area = width * height center_x = x + (width / 2) center_y = y + (height / 2) if object_area < found_area: object_area = found_area object_x = center_x object_y = center_y if object_area > 0: ball_location = [object_area, object_x, object_y] else: ball_location = None if ball_location: if (ball_location > minimum_area) and (ball_location < maximum_area): if ball_location > (center_image_x + (image_width/3)): robot.right(turn_speed) print("Turning right") elif ball_location < (center_image_x - (image_width/3)): robot.left(turn_speed) print("Turning left") else: robot.forward(forward_speed) print("Forward") elif (ball_location < minimum_area): robot.left(turn_speed) print("Target isn't large enough, searching") else: robot.stop() print("Target large enough, stopping") else: robot.left(turn_speed) print("Target not found, searching") rawCapture.truncate(0)
Running the Ball – Following Program
Place your robot in an open space on the floor with the yellow rubber ball.
Run the program.
Whenever you want to stop the program, type CTRL-C.