-The value for speed is directly proportional to the distance in inches from the sensor.
So, in loop(), change:
servoSpeed[roll]= 1;
servoSpeed[pitch]= 2;
servoSpeed[yaw]= 2;
servoSpeed[Boo]= 1;
to:
servoSpeed[roll]= inches/10;
servoSpeed[pitch]= 2 * inches/10;
servoSpeed[yaw]= 2 * inches/10;
servoSpeed[Boo]= inches/10;