Improve drivetrain calculations#14

Kyle-Eldridge wants to merge 5 commits intomainSlugbotics/URC2026:mainfrom

improve_drivetrainSlugbotics/URC2026:improve_drivetrainCopy head branch name to clipboard