Create command for autonomous game piece scoring

[katzuv]

The following steps should be taken:

• co-processor recognizes of vision target and calculating the polar coordinate of it
• Operator gets an indication that everything is set:
  • robot sees a vision target
  • robot owns a game piece (if it owns a Hatch Panel – make sure the Hatch Panel system faces the wall [you can check it with which camera out of the two sent the information])
  • reasonable measurements are sent from co-processor to roboRIO
• Operator clicks a button indicating the height level (Cargo Ship/Rocket 1/2/3)
• roboRIO creates path and follows it; raises Elevator to needed height and actuate relevant Intake.

Extras:

• create a similar command that collects a Hatch Panel automatically from a Loading Station
• make it simple for the driver to override the autonomous operation if something goes wrong.

[katzuv]

It's a WIP, but now I realize the final result is very different than the initial plan...