# Single Color Code Tracking Example
#
# This example shows off single color code tracking using the OpenMV Cam.
#
# A color code is a blob composed of two or more colors. The example below will
# only track colored objects which have both the colors below in them.
import sensor, image, time, math
# Color Tracking Thresholds (L Min, L Max, A Min, A Max, B Min, B Max)
# The below thresholds track in general red/green things. You may wish to tune them...
thresholds = [(30, 100, 15, 127, 15, 127), # generic_red_thresholds -> index is 0 so code == (1 << 0)
(30, 100, -64, -8, -32, 32)] # generic_green_thresholds -> index is 1 so code == (1 << 1)
# Codes are or'ed together when "merge=True" for "find_blobs".
sensor.reset()
sensor.set_pixformat(sensor.RGB565)
sensor.set_framesize(sensor.QVGA)
sensor.skip_frames(time = 2000)
sensor.set_auto_gain(False) # must be turned off for color tracking
sensor.set_auto_whitebal(False) # must be turned off for color tracking
clock = time.clock()
# Only blobs that with more pixels than "pixel_threshold" and more area than "area_threshold" are
# returned by "find_blobs" below. Change "pixels_threshold" and "area_threshold" if you change the
# camera resolution. "merge=True" must be set to merge overlapping color blobs for color codes.
while(True):
clock.tick()
img = sensor.snapshot()
for blob in img.find_blobs(thresholds, pixels_threshold=100, area_threshold=100, merge=True):
if blob.code() == 3: # r/g code == (1 << 1) | (1 << 0)
# These values depend on the blob not being circular - otherwise they will be shaky.
if blob.elongation() > 0.5:
img.draw_edges(blob.min_corners(), color=(255,0,0))
img.draw_line(blob.major_axis_line(), color=(0,255,0))
img.draw_line(blob.minor_axis_line(), color=(0,0,255))
# These values are stable all the time.
img.draw_rectangle(blob.rect())
img.draw_cross(blob.cx(), blob.cy())
# Note - the blob rotation is unique to 0-180 only.
img.draw_keypoints([(blob.cx(), blob.cy(), int(math.degrees(blob.rotation())))], size=20)
print(clock.fps())
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