Add brake functionality to drivetrain

[gregk27]

As motors are now set to coast, add functionality to drivetrain to put robot into a brake position

• [ ] Set swerve modules to point inward (like an X pattern)
• [ ] Do not interfere with existing drivetrain functionality
• [ ] Only engage when requested, and disengage when given driving instructions (so don't just brake when no other input given)