Need help with fixing my rounded rectangle calculation - C#