cleanup and fix some numerical scaling issues
support color in rigidbody flat terrain
support getting just the mass of a single robotnum
just get the mass of the quadrotor
blue terrain and faster execution
method to set geometry color
clean up a bit