fixed the moving to prespecified poses..
fixed a small bug..