Clean up and parameterize the speed controller.

[ethancoon]

Extract controller logic into its own function. Turn all thresholds (0.20, 0.10, 0.03, etc.) and scaling factors into config parameters. Use remaining_steps to adjust behavior near end of race.