| public GetWorldVector ( Vector2 &localVector ) : Vector2 | ||
| localVector | Vector2 | A vector fixed in the body. |
| return | Vector2 | |
public Vector2 GetWorldVector(ref Vector2 localVector)
{
return new Vector2(Xf.R.Col1.X*localVector.X + Xf.R.Col2.X*localVector.Y,
Xf.R.Col1.Y*localVector.X + Xf.R.Col2.Y*localVector.Y);
}
