Added dmpGetLinearAccel and dmpGetLinearAccelInWorld. Some vector algebra helpers.