[DEBUG] (All) Fixed controller position command