Fixed relative body translation. Increased controller frequency to maximum that was tested ok ~91Hz