Searched refs:local_origin (Results 1 – 2 of 2) sorted by relevance
2381 …s(btAlignedObjectArray<btQuaternion>& world_to_local,btAlignedObjectArray<btVector3>& local_origin) in forwardKinematics() argument2399 local_origin.resize(nLinks+1); in forwardKinematics()2402 local_origin[0] = getBasePos(); in forwardKinematics()2408 …local_origin[k+1] = local_origin[parent+1] + (quatRotate(world_to_local[k+1].inverse() , getRVecto… in forwardKinematics()2415 btVector3 posr = local_origin[index]; in forwardKinematics()2427 …s(btAlignedObjectArray<btQuaternion>& world_to_local,btAlignedObjectArray<btVector3>& local_origin) in updateCollisionObjectWorldTransforms() argument2430 local_origin.resize(getNumLinks()+1); in updateCollisionObjectWorldTransforms()2433 local_origin[0] = getBasePos(); in updateCollisionObjectWorldTransforms()2437 btVector3 posr = local_origin[0]; in updateCollisionObjectWorldTransforms()2453 …local_origin[k+1] = local_origin[parent+1] + (quatRotate(world_to_local[k+1].inverse() , getRVecto… in updateCollisionObjectWorldTransforms()[all …]
400 btAlignedObjectArray<btVector3> local_origin; in forwardKinematics() local405 bod->forwardKinematics(world_to_local,local_origin); in forwardKinematics()740 btAlignedObjectArray<btVector3> local_origin; in integrateTransforms() local781 local_origin.resize(nLinks+1); in integrateTransforms()783 bod->updateCollisionObjectWorldTransforms(world_to_local,local_origin); in integrateTransforms()