Fixed bug with old joint positions