Created test for RigidBodyInertialMeasurementUnit. Fixed some mistakes.
Added comparison between 2d and 3d IMUs. Currently fails because I can't construct a RigidBodyInertialMeasurementUnit for a PlanarRigidBodyManipulator.
Merge pull request #234 from tkoolen/imuTest

RigidBodyInertialMeasurementUnit