DCM Clean up and a little bit of tuning.

Fixed linear acceleration error