Added all C code necessary to run the puppetry platform at GT using the Bioloid CM5 micro controller.