Created a teleopFunctions & modularTeleop

Created a library of reusable functions for teleop programs, and created
a simple program to utilize them
Merge branch 'master' of https://github.com/IronEagles/Optimus