Localization working with two UltrasonicSensors
Localization functional
rudimentary block avoidance working
Block Avoidance works much better
Navigation Improved!
Block Avoidance Improved!

ToDo:

Improve block recognition
Improve Grabbing (?)
locking arm motor to prevent wobbling
changed a comment
Block avoidance changes based off which sensor sees the object
Block avoidance needs to choose direction relative to where on the field
it is located
block avoidance working
Block Avoidance working very well, merging to master
Merge branch 'DualUSBlockAvoidance'