import sensor
import time
import math
import omv
sensor.reset()
sensor.set_pixformat(sensor.GRAYSCALE)
sensor.set_framesize(sensor.VGA)
if omv.board_type() == "H7":
sensor.set_windowing((240, 240))
elif omv.board_type() == "M7":
sensor.set_windowing((200, 200))
else:
raise Exception("You need a more powerful OpenMV Cam to run this script")
sensor.skip_frames(time=2000)
sensor.set_auto_gain(False)
sensor.set_auto_whitebal(False)
clock = time.clock()
while True:
clock.tick()
img = sensor.snapshot()
for tag in img.find_apriltags():
img.draw_rectangle(tag.rect, color=127)
img.draw_cross(tag.cx, tag.cy, color=127)
print_args = (tag.name, tag.id, (180 * tag.rotation) / math.pi)
print("Tag Family %s, Tag ID %d, rotation %f (degrees)" % print_args)
print(clock.fps())