Added a stop() function to control_motion.cpp that sends a stopping signal to the core.
Implemented simple wall following behavior.