fixed quaternion interpolation for timestepMethod 2
tweaking of matlab friction