internal static double findAngleChangeBetweenOfConnectingRod(Joint From, Joint To) { return(Constants.Angle(From.X, From.Y, To.X, To.Y) - Constants.Angle(From.XLast, From.YLast, To.XLast, To.YLast)); }
internal static Point findGearTeethPointAlongConnectingRod(Joint center1, double rGear1, Joint center2, double rGear2) { var x = center1.X + rGear1 * (center2.X - center1.X) / (rGear2 + rGear1); var y = center1.Y + rGear1 * (center2.Y - center1.Y) / (rGear2 + rGear1); return(new Point(x, y)); }