Optimize sensors and fix wheel drive normalization

* Make sensor distances floats and use JBox2D fast methods
* Remove wheel drive normalization
* Remove use of Java 8 streams (slow and allocate a lot)
* Sort AgentSensor sensed objects