Basic case working good.
TODO:
-selectable number of legs
-joint direction setting
-measure/visualize velocity