Team TBS (McCormick Design Competition 2022)
→ Jackson Bremen, Garrett Short, Evan Waite
Development using PlatformIO in VSCode || Code to be executed on Teensy 4.0

Robot is working with dead reckoning via encoders. We were hoping to use gyroscopes/ IMU, but didn't recieve the parts Robot dispenses tokens continuously while moving Due to time constraints, we were not able to execute the robot as completely as we would have liked, but completed the task to a satisfactory level

*note - Tokens were not loaded on recorded run

Motor speeds are controlled via PID loop, allowing programmer to specify a speed in m/s, and the wheels will maintain speed to a high degree of fidelity
Robot uses PID for driving, both linearly and for turning; programmer specifies a distance to drive or an angle to turn at, and the robot executes the turn pretty well
Code is completely nonblocking and runs fast
Robot continuously dispenses tokens while robot moves

Code is written as object oriented C++. Motors, Dispenser are base classes. Robot holds instances of them as needed, and uses their functions (see MotorClass.h). Within Robot.cpp, the large switch statement in update_robot acts as a basic state machine, allowing us to step through the steps of the robot

Code to use MPU6050 was written but not integrated, as sensor precision was lacking

• Add sensors, such as laser rangefinders, IMU/Gyro/Magnetometer Sensor Suite, or bump sensors
• Refine hadware (3D print battery mounts, PCB mounts)
• Record video where robot is dispensing tokens
• Create built-in model of the course; allow robot to truly autonomously solve the course using TSP, Djikstra's, A*, or other
• Add a stop/ reset button to electronics stack