made arrays for 9 sensors, added PID function, need to figure out how to apply correction to the servos