Notes:
There are some things that I wasn't sure about, so I commented them, or did it in some way so you would correct it.
There is a little bit of code that still needs to be tested on a robot, but it's pretty straightforward. I will test it when I get the chance.
There are a lot of changes made to project files by vs code's Java extension.... Also, the wait a long time test fails on my machine for some reason. (unrelated to the changes)
Notes: There are some things that I wasn't sure about, so I commented them, or did it in some way so you would correct it. There is a little bit of code that still needs to be tested on a robot, but it's pretty straightforward. I will test it when I get the chance.
There are a lot of changes made to project files by vs code's Java extension.... Also, the wait a long time test fails on my machine for some reason. (unrelated to the changes)