changed steering function, minor overall tweaks

Tested code on rover, works when steering function is given a 90 deg
(straight ahead) reading. Actual steering still needs more testing.