/*
 *
 *  mur.sat
 *
 *  Somewhen in the year 2012, 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 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 "rda1846.h"

#define DEFAULT_FREQ 145900
int32_t current_freq_kHz = DEFAULT_FREQ;

static int32_t print_actual_freq(void)
{
  int32_t f = rda1846_get_freq_kHz();
  if(f < 0)
    printf("actual frequency: NaN MHz");
  else
    printf("actual frequency: %d.%03d MHz", (uint16_t)(f / 1000), (uint16_t)(f % 1000));
  return f;
}

static void update_current_freq(void)
{
  printf("setting frequency to %d.%03d MHz .. ", (uint16_t)(current_freq_kHz / 1000),
                                                 (uint16_t)(current_freq_kHz % 1000));
  if(rda1846_set_freq_kHz(current_freq_kHz))
    printf("error\r\n");
  else
    printf("ok\r\n");

  current_freq_kHz = print_actual_freq();
  if(current_freq_kHz < 0) 
    current_freq_kHz = DEFAULT_FREQ;
}

static void handle_cmd(uint8_t cmd)
{
  switch(cmd) {
  case '0': led_off(); printf("ok\r\n"); break;
  case '1': led_on(); printf("ok\r\n"); break;
  case 't': led_toggle(); printf("ok\r\n"); break;
  case '!': reset2bootloader(); break;
  case 'f': print_actual_freq(); break;
  case '+': current_freq_kHz+=500; update_current_freq(); break;
  case '-': current_freq_kHz-=500; update_current_freq(); break;
  default: printf("ERROR: unknown command\r\n"); return;
  }
}

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

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

  rda1846_init();
  rda1846_set_freq_kHz(current_freq_kHz);

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

    usbio_task();
  }
}