Add main.c cleanup so it doesnt include testing features for braking
Add small changes in utility_braking.c