Added Andrew's gait code

Cleaned up include structure.
Fixed bug in putf and removed math.h dependency.