Mag Testing

Looks Like the Mag code is working

Possibly needs the sign inverting.

Ready to start integrating into GUI