Adding more SMA stuff.
Coincident changes
Merge branch 'Cammode' of https://github.com/OlinRoboticsAndBioinspiration/dynaroach into Cammode