Asuro-syd is a project mainly written in C and PYTHON, it's free.
some code for the asuro robot
I did this for a practical course at the KIT.
Most of it doesn't work because the asuro robot broke down constantly, but there is some fine sensor-testing stuff on there