[20160914] Optimizing Reaction Force

[20160914] Optimizing Reaction Force

Optimization solver eventually fails to solve the problem but shows stable balance control before it fails.

 

nlopt: optimization open-source library

ReactionForceCtrl : all the torque command computation including reaction force distribution optimization