Work on acceleration code

Josh Leverette's picture

I started writing the code that would be needed to start integrating acceleration into the absolute position. I still need to actually rotate the acceleration values into the inertial reference frame, but I'm working on the surrounding code for the moment.