/FTCVuforiaDemo

Sample OpMode to demonstrate Vuforia Target Tracking in FTC

Primary LanguageJava

FTCVuforiaDemo

FTCVuforiaDemo

This linear opmode demonstrates one way to use Vuforia to track target images. It has been provided as Technology Outreach by FTC Team 2818 G-FORCE from Accident MD.

This Source Code:

Video Tutorial: Code Walk-Through

FTC Axis Geometry animation.

This code was written to be compatible with FTC_SDK V 2.62 (Dec 2016).

Place any of the four 2016/17 images on the field perimeter.

To test the OpMode, do the following:

  • Init the opmode
  • Manually move the robot to within a three feet of a target. Point the robot towards the target.
  • Verify that the target information appears on the Driver Station, and is correct.
  • Press Play to start the OpMode
  • Hold the Left Bumper to track to the target. Verify the driving data on the Driver Station.
  • Release the Left Bumper and use the gamepad Joysticks to drive towards another target.
  • Hold the Left Bumper to track to that target... etc.

All drive system components are located in the Robot_OmniDrive class.

The opmode assumes a three wheel omni-directional drive system, but it can be adapted to work with any omni drive (eg: mecanum).
Robot motion is defined by three axes: Axial / Lateral/ Yaw.
Actual motor speeds are calculated from these three axis motions.

All navigation components are located in the Robot_Navigation class

A simplified tracking approach is used, whereby the robot can be made to approach to within a set distance of any visible target.
Target localization is converted into a set of 6 values which can be used directly to navigate to the target.

  • robotX: Distance from target along X axis in mm. (will be negative)
  • robotY: Offset from target centerline along Y axis in mm. (can be + or -)
  • robotBearing: Direction Robot is pointing. (+ is CCW from x axis)
  • targetRange: Distance from robot centroid to target center in mm.
  • targetBearing: Direction from robot centroid to target center (+ is CCW from x axis)
  • relativeBearing: Angle from robot bearing to target bearing in degrees (+ is CCW)

A standoff TARGET_DISTANCE is defined in the TeleopOpMode to indicate how closely the robot should approach the target. The standdoff distance is measured from the center of the robot to the target in mm.

Telemetry Display

Telemetry Data displays robot and target information whenever a target is "visible" A sample display is shown here:

  • Visible blue near
  • Robot [X]:[Y] (B) [-646mm]:[80mm] (5°)
  • Target [R] (B):(RB) [651mm] (-7f°):(-12°)
  • Turn >>> CW 12°
  • Strafe RIGHT 80mm
  • Distance 646mm
  • Axes A[0.42], L[0.22], Y[-0.21]
  • Wheels L[-0.74], R[0.09], B[0.00]