Adding in limited finger control

Specifically 485e26c adds in a simple command array as a parameter for write_hubo_trajectory. If you have a better idea for how to do this, I'm all ears.

0f5189c is a pretty obvious choice. The endPose function only works with absolute transformation for some reason. This commit fixes that.