Esempio n. 1
0
static int inverse_leg(lua_State *L) {
  std::vector<double> qLeg;
  std::vector<double> pLeg = lua_checkvector(L, 1);
  int leg = luaL_checkint(L, 2);
  double hipYawPitch = 0;
  Transform trLeg = transform6D(&pLeg[0]);
  qLeg = darwinop_kinematics_inverse_leg(trLeg, leg, hipYawPitch);
  lua_pushvector(L, qLeg);
  return 1;
}
Esempio n. 2
0
std::vector<double>
darwinop_kinematics_inverse_rleg(Transform trLeg, double unused)
{
  return darwinop_kinematics_inverse_leg(trLeg, LEG_RIGHT, unused);
}