Ultrasonic now senses blocks, created touch

- Ultrasonic now senses blocks
- Created touch sensor
- Tweaked robot some more (still not ready yet!)

TODO: Make touch and ultrasonc sense diffrent directions