Compass Working Right

The compass is now working correctly, works 0-360. Not tilt compensated
though.
Test Program

Communicating with test Processing program and Arduino GPS placeholder.