Handled Mouth and Obstacles

Added the handleMouth() and handleObstacles() functions. Started the handleMedicine() function but cannot keep going without seeing how the color sensor works.