I could knock together working code for the robot but I'd need the frikking robot for hours to get everything working, debugged and interfaced right. It's not a 30 minute project even with the hardware and experience coding.
I'm so glad that your teacher will fix that code you have even though someone else wrote it.