         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_prev != g_aPins[i].is_servo )
+        {
+          if(!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].poServo->detach();
+            g_aPins[i].poServo->setFreqInSysFs(SYSFS_PWM_PERIOD_NS);
+//              Serial.print("Pin ");Serial.print(i);Serial.println(" detached.");
           }
-          
-          g_aPins[i].is_servo_prev = g_aPins[i].is_servo;
+          else
+          {
+            g_aPins[i].poServo->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;

    {
      if( g_aPins[i].is_analog ) // Process analog pins
      {
          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 );
          }
          else
          {
            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) );
