V5.3 Tested with new Algo

-Changed the double cup treatement
-Still worried about ultrasonic
-Tested, Buildable