Moved joystick control functions

They are now in functions.c, and have all had "Joystick" appended to
their name. The implementation has been mirrored to main teleop, and
should be implemented in system test and future teleop programs as well.