vectorToWorldFrame method

Vector3 vectorToWorldFrame(
  1. Vector3 localVector, [
  2. Vector3? result
])

Convert a local body point to world frame.

Implementation

Vector3 vectorToWorldFrame(Vector3 localVector, [Vector3? result]){
  result ??= Vector3.zero();
  quaternion.vmult(localVector, result);
  return result;
}