control enable flag
position integration fix rotation matrix