Now using functions to set vertibrae angles in moduleCode. They take care of the special cases.

Added ability to set angle setpoints in manual mode. Added ability to run the pid loop from manual mode.
Commenting, renamed StopMovement to stopMovement to hold naming convention. Used a bitshift when figuring out when to execute the PID loop (instead of divide by 2)