Create Code

This is the seccond version of the software we created. We don't use the third servo anymore.