public static Vector2D PointToWorldSpace(Vector2D point, Vector2D agentHeading, Vector2D agentSide, Vector2D agentPosition) { Vector2D transPoint = point; C2DMatrix matTransform = new C2DMatrix(); matTransform.Rotate(agentHeading, agentSide); matTransform.Translate(agentPosition.x, agentPosition.y); matTransform.TransformVector2Ds(ref transPoint); return(transPoint); }
public static Vector2D PointToWorldSpace(Vector2D point, Vector2D AgentHeading, Vector2D AgentSide, Vector2D AgentPosition) { //make a copy of the point Vector2D TransPoint = point; //create a transformation matrix C2DMatrix matTransform = new C2DMatrix(); //rotate matTransform.Rotate(AgentHeading, AgentSide); //and translate matTransform.Translate(AgentPosition.X, AgentPosition.Y); //now transform the vertices matTransform.TransformVector2Ds(TransPoint); return(TransPoint); }