pointToWorldFrame method

Vector3 pointToWorldFrame(
  1. Vector3 localPoint,
  2. Vector3? result
)

Convert a local body point to world frame.

Implementation

Vector3 pointToWorldFrame(Vector3 localPoint, Vector3? result){
  result ??= Vector3.zero();
  quaternion.vmult(localPoint, result);
  result.add2(position, result);
  return result;
}