This is James Hoekzema's code from the past week of separate coding.

This version includes:
Begin.vi & Finish.vi --Set up to current wiring as well as some items that we have yet to add
Camera Control.vi    --Used to control camera in a different way
Auto Align.vi        --Simply a place holder currently
toggle.vi            --a vi to toggle based off a button
cam coerce.vi        --a vi to coerce camera values (0 to 170)
Get Target Data.vi   --Used to get data from RoboRealm
climb mode.vi        --Controls are switched for climbing the pyramid
Filter Values.vi     --(not tested) used to control acceleration

Periodic Tasks.vi    --Updated to fit climb mode, drive mode, NOT shoot mode