Added a main program for exploring various ankle muscle controllers.

Also a few bug fixes on the optimization.