Simple example of object detection using ORB keypoints followed by 6D pose estimation in Python. More...

Public Member Functions
def	__init__ (self)
	Constructor. More...

def	loadCameraCalibration (self, w, h)
	Load camera calibration from JeVois share directory. More...

def	detect (self, imggray, outimg=None)
	Detect objects using keypoints. More...

def	estimatePose (self, hlist)
	Estimate 6D pose of each of the quadrilateral objects in hlist: More...

def	sendAllSerial (self, w, h, hlist, rvecs, tvecs)
	Send serial messages, one per object. More...

def	drawDetections (self, outimg, hlist, rvecs=None, tvecs=None)
	Draw all detected objects in 3D. More...

def	processNoUSB (self, inframe)
	Process function with no USB output. More...

def	process (self, inframe, outframe)
	Process function with USB output. More...

Public Attributes
	fname

	owm

	ohm

	wintop

	winleft

	winw

	winh

	distth

	timer

	camMatrix

	distCoeffs

	detector

	refdes

	refcorners

	wincorners

	matcher

Detailed Description

Simple example of object detection using ORB keypoints followed by 6D pose estimation in Python.

This module implements an object detector using ORB keypoints using OpenCV in Python. Its main goal is to also demonstrate full 6D pose recovery of the detected object, in Python, as well as locating in 3D a sub-element of the detected object (here, a window within a larger textured wall). See ObjectDetect for more info about object detection using keypoints. This module is available with JeVois v1.6.3 and later.

The algorithm consists of 5 phases:

detect keypoint locations, typically corners or other distinctive texture elements or markings;
compute keypoint descriptors, which are summary representations of the image neighborhood around each keypoint;
match descriptors from current image to descriptors previously extracted from training images;
if enough matches are found between the current image and a given training image, and they are of good enough quality, compute the homography (geometric transformation) between keypoint locations in that training image and locations of the matching keypoints in the current image. If it is well conditioned (i.e., a 3D viewpoint change could well explain how the keypoints moved between the training and current images), declare that a match was found, and draw a pink rectangle around the detected whole object.
finally perform 6D pose estimation (3D translation + 3D rotation), here for a window located at a specific position within the whole object, given the known physical sizes of both the whole object and the window within. A green parallelepiped is drawn at that window's location, sinking into the whole object (as it is representing a tunnel or port into the object).

For more information about ORB keypoint detection and matching in OpenCV, see, e.g., https://docs.opencv.org/3.4.0/d1/d89/tutorial_py_orb.html

This module is provided for inspiration. It has no pretension of actually solving the FIRST Robotics Power Up (sm) vision problem in a complete and reliable way. It is released in the hope that FRC teams will try it out and get inspired to develop something much better for their own robot.

Note how, contrary to FirstVision, DemoArUco, etc, the green parallelepiped is drawn going into the object instead of sticking out of it, as it is depicting a tunnel at the window location.

Using this module

This module is for now specific to the "exchange" of the FIRST Robotics 2018 Power Up (sm) challenge. See https://www.firstinspires.org/resource-library/frc/competition-manual-qa-system

The exchange is a large textured structure with a window at the bottom into which robots should deliver foam cubes.

A reference picture of the whole exchange (taken from the official rules) is in JEVOIS:/modules/JeVois/PythonObject6D/images/reference.png on your JeVois microSD card. It will be processed when the module starts. No additional training procedure is needed.

If you change the reference image, you should also edit:

values of self.owm and self.ohm to the width ahd height, in meters, of the actual physical object in your picture. Square pixels are assumed, so make sure the aspect ratio of your PNG image matches the aspect ratio in meters given by variables self.owm and self.ohm in the code.
values of self.wintop, self.winleft, self.winw, self.winh to the location of the top-left corner, in meters and relative to the top-left corner of the whole reference object, of a window of interest (the tunnel into which the cubes should be delivered), and width and height, in meters, of the window.

TODO: Add support for multiple images and online training as in ObjectDetect

Things to tinker with

There are a number of limitations and caveats to this module:

It does not use color, the input image is converted to grayscale before processing. One could use a different approach to object detection that would make use of color.
Results are often quite noisy. Maybe using another detector, like SIFT which provides subpixel accuracy, and better pruning of false matches (e.g., David Lowe's ratio of the best to second-best match scores) would help.
This algorithm is slow in this single-threaded Python example, and frame rate depends on image complexity (it gets slower when more keypoints are detected). One should explore parallelization, as was done in C++ for the ObjectDetect module. One could also alternate between full detection using this algorithm once in a while, and much faster tracking of previous detections at a higher framerate (e.g., using the very robust TLD tracker (track-learn-detect), also supported in OpenCV).
If you want to detect smaller objects or pieces of objects, and you do not need 6D pose, you may want to use modules ObjectDetect or SaliencySURF as done, for example, by JeVois user Bill Kendall at https://www.youtube.com/watch?v=8wYhOnsNZcc

Author: Laurent Itti

Display Name:: Python Object 6D

Videomapping:: YUYV 320 262 15.0 YUYV 320 240 15.0 JeVois PythonObject6D

Email:: itti@usc.edu

Address:: University of Southern California, HNB-07A, 3641 Watt Way, Los Angeles, CA 90089-2520, USA

Copyright: Copyright (C) 2018 by Laurent Itti, iLab and the University of Southern California

Main URL:: http://jevois.org

Support URL:: http://jevois.org/doc

Other URL:: http://iLab.usc.edu

License:: GPL v3

Distribution:: Unrestricted

Restrictions:: None

Definition at line 110 of file PythonObject6D.py.

Constructor & Destructor Documentation

◆ init()

def PythonObject6D.PythonObject6D.__init__ ( self )

Constructor.

Definition at line 113 of file PythonObject6D.py.

Member Function Documentation

◆ detect()

def PythonObject6D.PythonObject6D.detect	(	self,
		imggray,
		outimg = `None`
	)

Detect objects using keypoints.

Definition at line 150 of file PythonObject6D.py.

References hasattr().

Referenced by PythonObject6D.PythonObject6D.process(), and PythonObject6D.PythonObject6D.processNoUSB().

◆ drawDetections()

def PythonObject6D.PythonObject6D.drawDetections	(	self,
		outimg,
		hlist,
		rvecs = `None`,
		tvecs = `None`
	)

Draw all detected objects in 3D.

Definition at line 293 of file PythonObject6D.py.

References FirstPython.FirstPython.camMatrix, PythonObject6D.PythonObject6D.camMatrix, FirstPython.FirstPython.distCoeffs, PythonObject6D.PythonObject6D.distCoeffs, FirstVision::SinglePoseEstimationParallel.distCoeffs, demo.int, PythonObject6D.PythonObject6D.winh, and PythonObject6D.PythonObject6D.winw.

Referenced by PythonObject6D.PythonObject6D.process().

◆ estimatePose()

def PythonObject6D.PythonObject6D.estimatePose	(	self,
		hlist
	)

Estimate 6D pose of each of the quadrilateral objects in hlist:

Definition at line 245 of file PythonObject6D.py.

References FirstPython.FirstPython.camMatrix, PythonObject6D.PythonObject6D.camMatrix, FirstPython.FirstPython.distCoeffs, PythonObject6D.PythonObject6D.distCoeffs, FirstVision::SinglePoseEstimationParallel.distCoeffs, PythonObject6D.PythonObject6D.winh, and PythonObject6D.PythonObject6D.winw.

Referenced by PythonObject6D.PythonObject6D.process(), and PythonObject6D.PythonObject6D.processNoUSB().

◆ loadCameraCalibration()

def PythonObject6D.PythonObject6D.loadCameraCalibration	(	self,
		w,
		h
	)

Load camera calibration from JeVois share directory.

Definition at line 136 of file PythonObject6D.py.

Referenced by PythonObject6D.PythonObject6D.process(), and PythonObject6D.PythonObject6D.processNoUSB().

◆ process()

def PythonObject6D.PythonObject6D.process	(	self,
		inframe,
		outframe
	)

Process function with USB output.

Definition at line 392 of file PythonObject6D.py.

References ObjectMatcher.detect(), BlobDetector.detect(), FirstPython.FirstPython.detect(), PythonObject6D.PythonObject6D.detect(), FirstVision.detect(), QRcode.drawDetections(), ARtoolkit.drawDetections(), Yolo.drawDetections(), ArUco.drawDetections(), PythonObject6D.PythonObject6D.drawDetections(), FirstPython.FirstPython.drawDetections(), FirstVision.drawDetections(), PythonObject6D.PythonObject6D.estimatePose(), FirstPython.FirstPython.estimatePose(), FirstVision.estimatePose(), hasattr(), FirstPython.FirstPython.loadCameraCalibration(), PythonObject6D.PythonObject6D.loadCameraCalibration(), FirstVision.loadCameraCalibration(), PythonObject6D.PythonObject6D.sendAllSerial(), FirstPython.FirstPython.sendAllSerial(), FirstVision.sendAllSerial(), PythonTutorial2::PythonTutorial2.timer, PyModule::__MODULE__.timer, PyFaceMesh.PyFaceMesh.timer, PyHandDetector.PyHandDetector.timer, PyPoseDetector.PyPoseDetector.timer, PyDMTX.PyDMTX.timer, PySelfie.PySelfie.timer, PyObjectron.PyObjectron.timer, PyEmotion.PyEmotion.timer, PyLicensePlate.PyLicensePlate.timer, PyCoralDetect.PyCoralDetect.timer, PyCoralSegment.PyCoralSegment.timer, PySceneText.PySceneText.timer, PyCoralClassify.PyCoralClassify.timer, PyClassificationDNN.PyClassificationDNN.timer, FirstPython.FirstPython.timer, PyDetectionDNN.PyDetectionDNN.timer, and PythonObject6D.PythonObject6D.timer.

◆ processNoUSB()

def PythonObject6D.PythonObject6D.processNoUSB	(	self,
		inframe
	)

Process function with no USB output.

Definition at line 367 of file PythonObject6D.py.

References ObjectMatcher.detect(), BlobDetector.detect(), FirstPython.FirstPython.detect(), PythonObject6D.PythonObject6D.detect(), FirstVision.detect(), PythonObject6D.PythonObject6D.estimatePose(), FirstPython.FirstPython.estimatePose(), FirstVision.estimatePose(), hasattr(), FirstPython.FirstPython.loadCameraCalibration(), PythonObject6D.PythonObject6D.loadCameraCalibration(), FirstVision.loadCameraCalibration(), PythonObject6D.PythonObject6D.sendAllSerial(), FirstPython.FirstPython.sendAllSerial(), FirstVision.sendAllSerial(), PythonTutorial2::PythonTutorial2.timer, PyModule::__MODULE__.timer, PyFaceMesh.PyFaceMesh.timer, PyHandDetector.PyHandDetector.timer, PyPoseDetector.PyPoseDetector.timer, PyDMTX.PyDMTX.timer, PySelfie.PySelfie.timer, PyObjectron.PyObjectron.timer, PyEmotion.PyEmotion.timer, PyLicensePlate.PyLicensePlate.timer, PyCoralDetect.PyCoralDetect.timer, PyCoralSegment.PyCoralSegment.timer, PySceneText.PySceneText.timer, PyCoralClassify.PyCoralClassify.timer, PyClassificationDNN.PyClassificationDNN.timer, FirstPython.FirstPython.timer, PyDetectionDNN.PyDetectionDNN.timer, and PythonObject6D.PythonObject6D.timer.

◆ sendAllSerial()

def PythonObject6D.PythonObject6D.sendAllSerial	(	self,
		w,
		h,
		hlist,
		rvecs,
		tvecs
	)

Send serial messages, one per object.

Definition at line 269 of file PythonObject6D.py.

References FirstPython.FirstPython.ohm, PythonObject6D.PythonObject6D.ohm, FirstPython.FirstPython.owm, and PythonObject6D.PythonObject6D.owm.

Referenced by PythonObject6D.PythonObject6D.process(), and PythonObject6D.PythonObject6D.processNoUSB().

Member Data Documentation

◆ camMatrix

PythonObject6D.PythonObject6D.camMatrix

Definition at line 140 of file PythonObject6D.py.

Referenced by PythonObject6D.PythonObject6D.drawDetections(), and PythonObject6D.PythonObject6D.estimatePose().

◆ detector

PythonObject6D.PythonObject6D.detector

Definition at line 156 of file PythonObject6D.py.

◆ distCoeffs

PythonObject6D.PythonObject6D.distCoeffs

Definition at line 141 of file PythonObject6D.py.

Referenced by PythonObject6D.PythonObject6D.drawDetections(), and PythonObject6D.PythonObject6D.estimatePose().

◆ distth

PythonObject6D.PythonObject6D.distth

Definition at line 129 of file PythonObject6D.py.

◆ fname

PythonObject6D.PythonObject6D.fname

Definition at line 115 of file PythonObject6D.py.

◆ matcher

PythonObject6D.PythonObject6D.matcher

Definition at line 179 of file PythonObject6D.py.

◆ ohm

PythonObject6D.PythonObject6D.ohm

Definition at line 119 of file PythonObject6D.py.

Referenced by PythonObject6D.PythonObject6D.sendAllSerial().

◆ owm

PythonObject6D.PythonObject6D.owm

Definition at line 118 of file PythonObject6D.py.

Referenced by PythonObject6D.PythonObject6D.sendAllSerial().

◆ refcorners

PythonObject6D.PythonObject6D.refcorners

Definition at line 165 of file PythonObject6D.py.

◆ refdes

PythonObject6D.PythonObject6D.refdes

Definition at line 161 of file PythonObject6D.py.

◆ timer

PythonObject6D.PythonObject6D.timer

Definition at line 132 of file PythonObject6D.py.

Referenced by PythonOpenCV.PythonOpenCV.process(), PythonSandbox.PythonSandbox.process(), PythonParallel.PythonParallel.process(), PythonObject6D.PythonObject6D.process(), PythonTest.PythonTest.processGUI(), PythonSandbox.PythonSandbox.processGUI(), PythonSandbox.PythonSandbox.processNoUSB(), and PythonObject6D.PythonObject6D.processNoUSB().

◆ wincorners

PythonObject6D.PythonObject6D.wincorners

Definition at line 166 of file PythonObject6D.py.

◆ winh

PythonObject6D.PythonObject6D.winh

Definition at line 126 of file PythonObject6D.py.

Referenced by PythonObject6D.PythonObject6D.drawDetections(), and PythonObject6D.PythonObject6D.estimatePose().

◆ winleft

PythonObject6D.PythonObject6D.winleft

Definition at line 124 of file PythonObject6D.py.

◆ wintop

PythonObject6D.PythonObject6D.wintop

Definition at line 123 of file PythonObject6D.py.

◆ winw

PythonObject6D.PythonObject6D.winw

Definition at line 125 of file PythonObject6D.py.

Referenced by PythonObject6D.PythonObject6D.drawDetections(), and PythonObject6D.PythonObject6D.estimatePose().

The documentation for this class was generated from the following file:

src/Modules/PythonObject6D/PythonObject6D.py

Public Member Functions

Public Attributes

Detailed Description

Using this module

Things to tinker with

Constructor & Destructor Documentation

◆ __init__()

Member Function Documentation

◆ detect()

◆ drawDetections()

◆ estimatePose()

◆ loadCameraCalibration()

◆ process()

◆ processNoUSB()

◆ sendAllSerial()

Member Data Documentation

◆ camMatrix

◆ detector

◆ distCoeffs

◆ distth

◆ fname

◆ matcher

◆ ohm

◆ owm

◆ refcorners

◆ refdes

◆ timer

◆ wincorners

◆ winh

◆ winleft

◆ wintop

◆ winw

◆ init()