/*
 *
 *  mur.sat
 *
 *  Somewhen in the year 20xx, mur.at will have a nano satellite launched
 *  into a low earth orbit (310 km above the surface of our planet). The
 *  satellite itself is a TubeSat personal satellite kit, developed and
 *  launched by interorbital systems. mur.sat is a joint venture of mur.at,
 *  ESC im Labor and realraum.
 *
 *  Please visit the project hompage at sat.mur.at for further information.
 *
 *
 *  Copyright (C) 2013-2015 Christian Pointner <equinox@mur.at>
 *
 *  This file is part of mur.sat.
 *
 *  mur.sat is free software: you can redistribute it and/or modify
 *  it under the terms of the GNU General Public License as published by
 *  the Free Software Foundation, either version 3 of the License, or
 *  any later version.
 *
 *  mur.sat 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.
 *
 *  You should have received a copy of the GNU General Public License
 *  along with mur.sat. If not, see <http://www.gnu.org/licenses/>.
 *
 */

#include <avr/io.h>
#include <avr/wdt.h>
#include <avr/interrupt.h>
#include <avr/power.h>
#include <stdio.h>

#include "led.h"
#include "util.h"
#include "usbio.h"

#include "hhd70.h"
#include "cc1101.h"
#include "cc1101_defines.h"

#define DEFAULT_FREQ 437525000
int32_t current_freq_hz = DEFAULT_FREQ;

static void reset_hhd70(void)
{
  printf("soft resetting HHD70.\r\n");
  cc1101_soft_reset();
}

static void reinit_hhd70(void)
{
  printf("initializing HHD70.\r\n");
  cc1101_reg_init();
}

static void powerdown_hhd70(void)
{
  printf("sending CC1101 to sleep.\r\n");
  cc1101_powerdown();
}

static void osc_off_hhd70(void)
{
  printf("disabling CC1101 oscillator.\r\n");
  cc1101_osc_off();
}

static uint32_t print_actual_freq(void)
{
  uint32_t f = cc1101_get_freq_hz();
  uint16_t hz = f % 1000;
  uint16_t mhz = f / 1000000;
  uint16_t khz = (f % 1000000)/1000;
  printf("actual frequency: %d.%03d%03d MHz\r\n", mhz, khz, hz);
  return f;
}

static void update_current_freq(void)
{
  uint16_t hz = current_freq_hz % 1000;
  uint16_t mhz = current_freq_hz / 1000000;
  uint16_t khz = (current_freq_hz % 1000000)/1000;
  printf("setting frequency to %d.%03d%03d MHz\r\n", mhz, khz, hz);

      // TODO: goto idle mode

  cc1101_set_freq_hz(current_freq_hz);

      // TODO: if old mode wasn't idle go back to this mode

  print_actual_freq();
}

static void print_status(void)
{
  printf("current state: %s\r\n", cc1101_state_to_string(cc1101_get_state()));

  int16_t rssi = (int16_t)cc1101_get_rssi();
  printf("rssi: ");
  if(rssi < 0) {
    printf("-");
    rssi*=-1;
  }
  printf("%d.%01d dB\r\n", (uint16_t)(rssi / 2), (uint16_t)((rssi % 2)*5));
}

static void handle_cmd(uint8_t cmd)
{
  switch(cmd) {
  case '0': led_off(); printf("led OFF\r\n"); break;
  case '1': led_on(); printf("led ON\r\n"); break;
  case 't': led_toggle(); printf("led TOGGLE\r\n"); break;
  case '!': cc1101_soft_reset(); reset2bootloader(); break;

  case 'r': reset_hhd70(); break;
  case 'i': reinit_hhd70(); break;
  case 'F': current_freq_hz = DEFAULT_FREQ; update_current_freq(); break;

  case '#': current_freq_hz+=100000; update_current_freq(); break;
  case '+': current_freq_hz+=10000; update_current_freq(); break;
  case ':': current_freq_hz+=1000; update_current_freq(); break;
  case '.': current_freq_hz-=1000; update_current_freq(); break;
  case '-': current_freq_hz-=10000; update_current_freq(); break;
  case '_': current_freq_hz-=100000; update_current_freq(); break;

  case 'P': powerdown_hhd70(); break;
  case 'I': cc1101_idle(); print_status(); break;
  case 'O': osc_off_hhd70();  break;
  case 'C': cc1101_calibrate(); print_status(); break;
  case 'X': cc1101_fasttxon(); print_status(); break;
  case 'R': cc1101_rx(); print_status(); break;
  case 'T': cc1101_tx(); print_status(); break;

  case 'f': print_actual_freq(); break;
  case 's': print_status(); break;
  case 'D': cc1101_dump_register(); break;

  default: printf("unknown command\r\n"); return;
  }
}

int main(void)
{
  MCUSR &= ~(1 << WDRF);
  wdt_disable();

  cpu_init();
  led_init();
  usbio_init();

  hhd70_init();

  sei();
  for(;;) {
    int16_t BytesReceived = usbio_bytes_received();
    while(BytesReceived > 0) {
      int ReceivedByte = fgetc(stdin);
      if(ReceivedByte != EOF) {
        handle_cmd(ReceivedByte);
      }
      BytesReceived--;
    }

    usbio_task();
  }
}