tested and fixed some issues. filter 1 working as it should it seems, but...

tested and fixed some issues. filter 1 working as it should it seems, but filter two is not. probably due to opposite min/max. to be fixed

4DrobotServer/ServoControl.ino

@@ -118,7 +118,7 @@ void filter_control(int filter) {
   bufferWrite(output_buff, sizeof(output_buff), output_buffCount, F("< FILTER MOVING...\n"));
   output_buff_flush();
 
-  while (filter_pos != filter_goto) {
+  while (filter_pos[filter] != filter_goto[filter]) {
     if (digitalRead(emergency_stop_pin) == emergency_isEmergency) {
       bufferWrite(output_buff, sizeof(output_buff), output_buffCount, F("< FILTER ERROR EMERGENCY STOP\n"));
       break;