Feat/better intake tests

[danielbrownmsm]

Better Intake Unit Tests

Summary The drivetrain subsystem has decent unit tests covering a range of functions. The intake currently only tests initialization. It should test more.

Work Required

• add unit test for setting intake power
• add unit test for setting indexer power
• add unit test for setting intake position
• add unit test for getting intake position
• add unit test (this is the hard/complicated one) for verifying intake position logic (ie it starts raised, then tell it to deploy, verify motor output, tell it that it’s deployed, verify output, tell it to retract, verify output, tell it it’s retracted, verify output)

Verification

• CI passes
• Unit tests cover the list of functions listed in work required above
• Code is sufficiently commented and documented