[MDav]

This is a very good start.

In Teleop, I think you may want to score "by stack" as multiple containers can be used and at multiple heights. Scoring by stack would allow you to better handle this scenario.

I would also consider adding a "Back" or "Reset" button in case the user keys an error.