Added FK and IK for legs to hubo_plus.h and hubo_plus.cpp.