fixed setup_rigid_bodies in SimplifiedModel