Align to the amp with AprilTags

[spamtactics]

No description provided.

[spamtactics]

This command semi-autonomously aligns the robot to be able to shoot a note into the amp.
The actual shooting command will have to be queued after this.

[spamtactics]

"Note that the above drawings was somethin that I thought of myself and is in no way the most optimal way to do this. If someone can find a more in depth explanation, please tell me" This is the basic theory on how we can use the difference between the X coordinates of the april Tag to calculate the angle offset we need to turn the robot by.