Plot body positions in tests/inverse-kinematics.cc