 }
 
 void moveServoToLastPosition(byte idx){
-    byte pos=cbus.getInternalNodeVar(idx+1);
+    byte pos=cbus.getInternalNodeVar(idx+1);    
     if (pos < 175){
        servos[idx].write(pos,SPEED);
     }

      if (isServoToTogle(servoidx)){
        //Serial.println("off-moving servo t");
        servos[servoidx].write(servo_end,SPEED);
	lastPos = servo_end;
      }
      else {
        //Serial.println("off-moving servo");

      case 0: //do nothing        
      break;
      case 1://move to start position
	       servos[i].write(15,SPEED);
      break;
      case 2://mode to end position        
      	servos[i].write(170,SPEED);
      break;
      case 3://move to last position          
          moveServoToLastPosition(i);
      break;
    }    
