public static TSVector2 BodyToWorldPoint(
TSVector2 bodyPosition,
TSVector2 bodyFacing,
TSVector2 vector)
{
return(vector.Rotate(bodyFacing) + bodyPosition);
}
private void ApplyContactImpulse(
VoltBody bodyA,
VoltBody bodyB,
FP normalImpulseMagnitude,
FP tangentImpulseMagnitude)
{
TSVector2 impulseWorld =
new TSVector2(normalImpulseMagnitude, tangentImpulseMagnitude);
TSVector2 impulse = impulseWorld.Rotate(this.normal);
bodyA.ApplyImpulse(-impulse, this.toA);
bodyB.ApplyImpulse(impulse, this.toB);
}
public static TSVector2 BodyToWorldDirection(
TSVector2 bodyFacing,
TSVector2 vector)
{
return(vector.Rotate(bodyFacing));
}