added simple pid controller
added basic tick-based velocity control code
tidied abstractions up

added full distinction between vels and pose
made timeStep parameter replace looprate robot member
now robot contains a pose and a vels member
btw none of this has been compiled or tested...