Update physics model so robot works