Removed auto count # of modules. You must set # of modules in the head manually.
Re-implemented initializing angle array from current position
POSSIBLY BUGGY: Added reading pressure sensor from manual mode. Fixed bug where setting module number from manual mode would not re-init even and odd PID. Added printing out headCode any arrays. Revamped read sensor values function to print current setpoints too.