Added a main testing function for exercising the KobukiRobot and
debugging.
Modified the KobukiRobot to protect the threading model from outside
use.