Commit after first day of competition

Motor controllers work, ready to test