JoyAngleIntegrater implemented in C++.  Not quite finished (1 line of code is not working...)