Basic UNIT testing support

[joecaraccio]

https://docs.wpilib.org/en/stable/docs/software/wpilib-tools/robot-simulation/unit-testing.html

• Setup Basic Robot Unit Testing

• Github Workflow to run it when we check in our code

• Make Tests Package

• Be able to call various subsystems and test

[averwhy]

Maybe