Set Up Program structure

[Anemnox]

Design and make a structure for the program to run

[Anemnox]

• Initialize Robot

• Initialize Major Subsystems (Drivers, Gears, Shooter, etc)

• Initialize Commands and organize into Major Subsystems (Shooter Aim >> Shooter, Gears Servo >> Gears)

• Communicate from Robot to Major Subsystem to Minor Subsystem to get data or Input data and output action.