https://www.tinkercad.com/things/97SF6908Lzm-cain
This was my idea I made up with the assistance of my two group mates Dimitri Sholtis and Ruben Raines.
This was the code we used and developed during one of our robot designs. Team members were Aaron Gothard, Ruben Raines, and yours truly