2010 FRC robot code (Python rewrite)