C robot control

We need to include License headers on all these files.  See examples in the rest of the project