arduino code for 3-d scanner, should step two servos and read sensor value, has not been tested