Optimize for when motor switch is off, no longer do any calculations.
Drive forward as long as nothing is within 10cm in front, and switch2 is on