Locomotion control compiling and running

This version of the module compiles and runs fine on Windows (segfault
when closing in resource finder destructor).
Working on task hierarchy resolution.
Starting adapting vectors/matrices to variable size structure (to
enable/disable joints).