Initial Commit

Quick motor/servo test by Mr. C
To be replaced with student code