(Stabilizer.cpp) : Use :end_effector instead of link origin in IK and fix mode transition
Merge pull request #249 from snozawa/update_st_calculation

Use :end_effector instead of link origin in IK and fix mode transition