12/14

Angles are all computed. Still need to code the serial sending.