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)); }