     {
       if( g_aPins[i].is_analog ) // Process analog pins
       {
-        if(i == 3) // DEBUGGING
-        {
           if( !g_aPins[i].is_servo ) // Process servo output pins
           {
      //       Serial.print("Pin #");Serial.print(i);Serial.print(": ");
             analogWrite(i, getTotalPinValue(i)*ANALOG_OUT_MAX_VALUE );
-     //       delay(15);                       // waits 15ms for the servo to reach the position 
           }
           else
           {
-//            g_aPins[i].poServo->write(int(getTotalPinValue(i)*ANALOG_OUT_MAX_VALUE));
-            g_aPins[i].oServo.write(int(getTotalPinValue(i)*ANALOG_OUT_MAX_VALUE));
-            delay(15);                       // waits 15ms for the servo to reach the position 
+            g_aPins[i].poServo->write(int(getTotalPinValue(i)*ANALOG_OUT_MAX_VALUE));
           }
     //      Serial.print(i);Serial.print(": ");
     //      Serial.println(getTotalPinValue(i)*ANALOG_OUT_MAX_VALUE);
-        }
       }
       else // Process digital pins     
         digitalWrite(i, getTotalPinValue(i) );

        g_aPins[i].is_servo = poIsServo->valuebool;

        ////////////////////////// Changing Analog Pin to Servo //////////////////////////
       if(i == 3) // DEBUGGING
       {
          if( g_aPins[i].is_servo_prev != g_aPins[i].is_servo )
          {
            if(!g_aPins[i].is_servo)
            {
//              g_aPins[i].poServo->detach();
//              g_aPins[i].poServo->setFreqInSysFs(SYSFS_PWM_PERIOD_NS);
              g_aPins[i].oServo.detach();
              g_aPins[i].oServo.setFreqInSysFs(SYSFS_PWM_PERIOD_NS);
              Serial.print("Pin ");Serial.print(i);Serial.println(" detached.");
            }
            else
            {
             // g_aPins[i].poServo->attach(i); 
              g_aPins[i].oServo.attach(i); 
              Serial.print("Pin ");Serial.print(i);Serial.println(" attached.");
            }
          }
          
          g_aPins[i].is_servo_prev = g_aPins[i].is_servo;
        }
        ////////////////////////////////////////////////////
      }
      else

  int is_input;
  int is_servo;
  int is_servo_prev;
  Servo* poServo;
 // Servo oServo;
  float input_min;
  float input_max;
//  float sensitivity;
