 
 void loop(void)
 {
- 
+  
+  
   tx_payload.throttle = joystickMapValues(analogRead(PIN_THROTTLE), 125, 515, 1000);
   tx_payload.yaw      = joystickMapValues(analogRead(PIN_YAW), 10, 521, 1000);
   tx_payload.pitch    = joystickMapValues(analogRead(PIN_PITCH), 0, 511, 1023);

          //unsigned long tim = micros();
          radio.read( &ack_payload, sizeof(ack_t) );
          ppsCounter++;
          monitor_sendData();
          if (DEBUG) {
            //printf("Got response %d, pps: %d \n\r", ack_payload.val, pps);
          }

  }
}

void monitor_sendLocalData() {
  static byte i = 0; 
  
  switch (i) {
    case 0:
      ack_payload.val = tx_payload.throttle; 
      break;
    case 1:
      ack_payload.val = tx_payload.yaw; 
      break;
    case 2:
      ack_payload.val = tx_payload.pitch; 
      break;
    case 3:
      ack_payload.val = tx_payload.roll; 
      break;
  } 
      
  if (++i > 3) {
    i = 0; 
  }
  
  monitor_sendData();
}

