This has working Servo and Sensor code.  The Sensor is not working right though.  It detects too much noise, so I tried taking an average of several hundred runs, but that just slows it way down.  So we need to do some testing. People on the internet said they had a hard time getting reliable readings past one meter.