Subversion Repositories FlightCtrl

#include "externalControl.h"
#include "configuration.h"
#include "controlMixer.h"

ExternalControl_t externalControl;
uint8_t externalControlActive = 0;
// int16_t EC_PRTY[4];
// TODO: Who is going to call this

void EC_setNeutral(void) {
  // if necessary. From main.c.
  externalControl.config = 0;
  externalControl.pitch = 0;
  externalControl.roll = 0;
  externalControl.yaw = 0;
  externalControl.throttle = 0;

  // From main.c. What does it do??
  externalControl.digital[0] = 0x55;
}

void EC_periodicTaskAndPRTY(int16_t* PRTY) {
  if (externalControlActive) {
    externalControlActive--;
    PRTY[CONTROL_ELEVATOR] += externalControl.pitch * 8;
    PRTY[CONTROL_AILERONS] += externalControl.roll * 8;
    PRTY[CONTROL_THROTTLE] += externalControl.throttle * 8;
    PRTY[CONTROL_RUDDER] += externalControl.yaw * 8;
  }
}

uint8_t EC_getArgument(void) {
  return externalControl.config;
}

uint8_t EC_getCommand(void) {
  return externalControl.free;
}

// not implemented.
int16_t EC_getVariable(uint8_t varNum) {
  return 0;
}

uint8_t EC_getSignalQuality(void) {
  if (externalControlActive > 40)
    // Configured and heard from recently
    return SIGNAL_GOOD;

  if (externalControlActive)
    // Configured and heard from
    return SIGNAL_OK;

  if (!(externalControl.config & 0x01 && dynamicParams.externalControl > 128))
    // External control is not even configured.
    return NO_SIGNAL;

  // Configured but expired.
  return SIGNAL_LOST;
}