ok done with pose feedback control.