/*
 * Authors (alphabetical order)
 * - Andre Bernet <bernet.andre@gmail.com>
 * - Andreas Weitl
 * - Bertrand Songis <bsongis@gmail.com>
 * - Bryan J. Rentoul (Gruvin) <gruvin@gmail.com>
 * - Cameron Weeks <th9xer@gmail.com>
 * - Erez Raviv
 * - Gabriel Birkus
 * - Jean-Pierre Parisy
 * - Karl Szmutny
 * - Michael Blandford
 * - Michal Hlavinka
 * - Pat Mackenzie
 * - Philip Moss
 * - Rob Thomson
 * - Romolo Manfredini <romolo.manfredini@gmail.com>
 * - Thomas Husterer
 *
 * opentx is based on code named
 * gruvin9x by Bryan J. Rentoul: http://code.google.com/p/gruvin9x/,
 * er9x by Erez Raviv: http://code.google.com/p/er9x/,
 * and the original (and ongoing) project by
 * Thomas Husterer, th9x: http://code.google.com/p/th9x/
 *
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License version 2 as
 * published by the Free Software Foundation.
 *
 * This program is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 * GNU General Public License for more details.
 *
 */

#include "../opentx.h"

#if defined(ROTARY_ENCODER_NAVIGATION)

#if defined(TELEMETREZ)
uint8_t TrotCount ;             // TeZ version
uint8_t LastTrotCount ;         // TeZ version
uint8_t RotEncoder ;
#define ROTENC_DOWN() (RotEncoder != 0)
#else
uint8_t RotPosition ;
int8_t LastRotaryValue ;
int8_t Rotary_diff ;
int8_t RotaryControl ;
uint8_t RotEncoder ;
#define ROTENC_DOWN() (RotEncoder & 0x20)
#endif

void rotencPoll()
{
#if defined(TELEMETREZ)
  if (TrotCount != LastTrotCount) {
    g_rotenc[0] = LastTrotCount = TrotCount ;
  }
#else
  // Rotary Encoder polling
  PORTA = 0 ;                     // No pullups
  DDRA = 0x1F ;           // Top 3 bits input

  asm(" rjmp 1f") ;
  asm("1:") ;

  uint8_t rotary ;
  rotary = PINA ;
  DDRA = 0xFF ;           // Back to all outputs
  rotary &= 0xE0 ;

  RotEncoder = rotary ; // just read the lcd pin

  rotary &= 0xDF ;
  if ( rotary != RotPosition ) {
    uint8_t x ;
    x = RotPosition & 0x40 ;
    x <<= 1 ;
    x ^= rotary & 0x80 ;
    if ( x ) {
      g_rotenc[0] -= 1 ;
    }
    else {
      g_rotenc[0] += 1 ;
    }
    RotPosition = rotary ;
  }
#endif // TELEMETREZ
}
#else
#define ROTENC_DOWN() (0)
#endif // ROTARY_ENCODER_NAVIGATION

#ifndef SIMU
inline void boardInit()
{
  // Set up I/O port data directions and initial states
  DDRA = 0xff;  PORTA = 0x00; // LCD data
  DDRB = 0x81;  PORTB = 0x7e; //pullups keys+nc
  DDRC = 0x3e;  PORTC = 0xc1; //pullups nc
  DDRD = 0x00;  PORTD = 0xff; //pullups keys
  DDRE = (1<<OUT_E_BUZZER); PORTE = 0xff-(1<<OUT_E_BUZZER); //pullups + buzzer 0
  DDRF = 0x00;  PORTF = 0x00; //anain
  DDRG = 0x14;  PORTG = 0xfb; //pullups + SIM_CTL=1 = phonejack = ppm_in, Haptic output and off (0)

  ADMUX=ADC_VREF_TYPE;
  ADCSRA=0x85; // ADC enabled, pre-scaler division=32 (no interrupt, no auto-triggering)

  // TCNT0  10ms = 16MHz/1024/156 periodic timer (9.984ms)
  // (with 1:4 duty at 157 to average 10.0ms)
  // Timer overflows at about 61Hz or once every 16ms.
  TCCR0  = (0b111 << CS00); // Norm mode, clk/1024
  OCR0 = 156;

#if defined(AUDIO) || defined(VOICE)
  TCCR2  = (0b010 << CS00); // Norm mode, clk/8
#elif defined(PWM_BACKLIGHT)
  /** Smartieparts LED Backlight is connected to PORTB/pin7, which can be used as pwm output of timer2 **/
#if defined(SP22)
  TCCR2  = (0b011 << CS20)|(1<<WGM20)|(1<<COM21)|(1<<COM20); // inv. pwm mode, clk/64
#else
  TCCR2  = (0b011 << CS20)|(1<<WGM20)|(1<<COM21); // pwm mode, clk/64
#endif
#endif

  TIMSK |= (1<<OCIE0) | (1<<TOIE0) | (1<<TOIE2); // Enable Output-Compare and Overflow interrrupts
}
#endif

#ifndef SIMU
FORCEINLINE
#endif
uint8_t keyDown()
{
  return ((~PINB) & 0x7E) | ROTENC_DOWN();
}

bool switchState(EnumKeys enuk)
{
  uint8_t result = 0 ;

  if (enuk < (int)DIM(keys))
    return keys[enuk].state();

  switch(enuk){
    case SW_ELE:
      result = PINE & (1<<INP_E_ElevDR);
      break;

#if defined(JETI) || defined(FRSKY) || defined(ARDUPILOT) || defined(NMEA) || defined(MAVLINK)
    case SW_AIL:
      result = PINC & (1<<INP_C_AileDR); //shad974: rerouted inputs to free up UART0
      break;
#else
    case SW_AIL:
      result = PINE & (1<<INP_E_AileDR);
      break;
#endif

    case SW_RUD:
      result = PING & (1<<INP_G_RuddDR);
      break;
      //     INP_G_ID1 INP_E_ID2
      // id0    0        1
      // id1    1        1
      // id2    1        0
    case SW_ID0:
      result = !(PING & (1<<INP_G_ID1));
      break;

    case SW_ID1:
      result = (PING & (1<<INP_G_ID1)) && (PINE & (1<<INP_E_ID2));
      break;

    case SW_ID2:
      result = !(PINE & (1<<INP_E_ID2));
      break;

#if defined(EXTRA_3POS)
    case SW_ID3:
      result = (calibratedStick[POT1+EXTRA_3POS-1] < 0);
      break;

    case SW_ID4:
      result = (calibratedStick[POT1+EXTRA_3POS-1] == 0);
      break;

    case SW_ID5:
      result = (calibratedStick[POT1+EXTRA_3POS-1] > 0);
      break;
#endif

    case SW_GEA:
      result = PINE & (1<<INP_E_Gear);
      break;

    //case SW_THR  : return PINE & (1<<INP_E_ThrCt);

#if defined(JETI) || defined(FRSKY) || defined(ARDUPILOT) || defined(NMEA) || defined(MAVLINK)
    case SW_THR:
      result = PINC & (1<<INP_C_ThrCt); //shad974: rerouted inputs to free up UART0
      break;

#else
    case SW_THR:
      result = PINE & (1<<INP_E_ThrCt);
      break;
#endif

    case SW_TRN:
      result = PINE & (1<<INP_E_Trainer);
      break;

    default:
      break;
  }

  return result;
}

#ifndef SIMU
FORCEINLINE
#endif
void readKeysAndTrims()
{
  uint8_t enuk = KEY_MENU;

  // User buttons ...
  uint8_t in = ~PINB;

  for(int i=1; i<7; i++)
  {
    //INP_B_KEY_MEN 1  .. INP_B_KEY_LFT 6
    keys[enuk].input(in & (1<<i),(EnumKeys)enuk);
    ++enuk;
  }

  // Trim switches ...
  static const pm_uchar crossTrim[] PROGMEM ={
    1<<INP_D_TRM_LH_DWN,  // bit 7
    1<<INP_D_TRM_LH_UP,
    1<<INP_D_TRM_LV_DWN,
    1<<INP_D_TRM_LV_UP,
    1<<INP_D_TRM_RV_DWN,
    1<<INP_D_TRM_RV_UP,
    1<<INP_D_TRM_RH_DWN,
    1<<INP_D_TRM_RH_UP    // bit 0
  };

  in = ~PIND;

  for (int i=0; i<8; i++) {
    // INP_D_TRM_RH_UP   0 .. INP_D_TRM_LH_UP   7
    keys[enuk].input(in & pgm_read_byte(crossTrim+i), (EnumKeys)enuk);
    ++enuk;
  }

#if defined(ROTARY_ENCODER_NAVIGATION)
  keys[enuk].input(ROTENC_DOWN(), (EnumKeys)enuk); // Rotary Enc. Switch
#endif
}

bool checkSlaveMode()
{
  // no power -> only phone jack = slave mode
  static bool lastSlaveMode = false;
  static uint8_t checkDelay = 0;
  if (IS_AUDIO_BUSY()) {
    checkDelay = 20;
  }
  else if (checkDelay) {
    --checkDelay;
  }
  else {
    lastSlaveMode = (PING & (1<<INP_G_RF_POW));
  }
  return lastSlaveMode;
}

#if defined(PWM_BACKLIGHT)

// exponential PWM table for linear brightness
static const uint8_t pwmtable[16] PROGMEM =
{
    0, 2, 3, 4, 6, 8, 11, 16, 23, 32, 45, 64, 90, 128, 181, 255
};

static uint8_t bl_target;
static uint8_t bl_current;

void backlightFadeOn()
{
  bl_target = 15 - g_eeGeneral.blOnBright;
}

void backlightFadeOff()
{
  bl_target = g_eeGeneral.blOffBright;
}

bool getBackLightState()
{
  return (bl_target==g_eeGeneral.blOnBright);
}

void backlightFade() //called from per10ms()
{
  if (bl_target != bl_current) {
    if (bl_target > bl_current)
      OCR2 = pgm_read_byte(&pwmtable[++bl_current]);
    else
      OCR2 = pgm_read_byte(&pwmtable[--bl_current]);
  }
}

#endif