Fixed bug in pose updates