Actually pass correct tm_diff to physics functions
Give the physics sim more control

- Control robot starting position
- Robot size
- Scale units appropriately