Added classes for Hexapod itself (handles leg updates / initialization). Fixed some issues with servo movement