/* direct key io driver for NXT brick

  Copyright (C) 2007 Free Software Foundation, Inc.

  This file is part of Gforth.

  Gforth 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 2
  of the License, or (at your option) any later version.

  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.

  You should have received a copy of the GNU General Public License
  along with this program; if not, write to the Free Software
  Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111, USA.

  The following is stolen from the readline library for bash
*/

#include "config.h"
#include "forth.h"
#include "../arch/arm/nxt/AT91SAM7.h"
#include "../arch/arm/nxt/bt.h"
#include "../arch/arm/nxt/display.h"
#include "../arch/arm/nxt/aic.h"
#include "../arch/arm/nxt/systick.h"
#include "../arch/arm/nxt/sound.h"
#include "../arch/arm/nxt/interrupts.h"
#include "../arch/arm/nxt/nxt_avr.h"
#include "../arch/arm/nxt/nxt_motors.h"
#include "../arch/arm/nxt/i2c.h"

int terminal_prepped = 0;
int needs_update = 0;
int bt_mode = 0;

void
show_splash(U32 milliseconds)
{
  display_clear(0);
  display_goto_xy(6, 6);
  display_string("Gforth");
  display_update();

  systick_wait_ms(milliseconds);
}

const static bt_lens[0x3C] = { 10, 3, 10, 3,  10, 30, 10, 3,  4, 4, 26, 4,  3, 0, 0, 0,
			       0, 0, 0, 0,    0, 0, 0, 0,     0, 0, 0, 0,   4, 4, 0, 0,
			       0, 19, 0, 4,   0, 3, 0, 3,     0, 3, 3, 3,   0, 0, 0, 3,
			       0, 0, 0, 3, 5, 0, 3, 4, 0,     3, 0, 3, 0 };

void bt_send_cmd(char * cmd)
{
  int len = bt_lens[cmd[1]];
  int i, sum=0;

  cmd[0] = len;
  for(i=1; i<len-2; i++)
    sum += cmd[i];
  cmd[i++] = (char)(sum>>8);
  cmd[i++] = (char)(sum & 0xff);

  bt_send(cmd, len);
}

void prep_terminal ()
{
  char cmd[30];

  aic_initialise();
  interrupts_enable();
  systick_init();
  sound_init();
  nxt_avr_init();
  display_init();
  nxt_motor_init();
  i2c_init();
  bt_init();
  cmd[1] = 3;
  bt_send_cmd(cmd); // open port query

  display_goto_xy(0,0);
  display_clear(1);

  terminal_prepped = 1;
}

void deprep_terminal ()
{
  terminal_prepped = 0;
}

void do_bluetooth ()
{
  if(!bt_mode) {
    char cmd[30];

    bt_receive(cmd);
    
    switch(cmd[1]) {
    case 0x16: // request connection
      cmd[1] = 9; // accept connection
      cmd[2] = 1; // yes, we do
      bt_send_cmd(cmd);
      break;
    case 0x13: // connect result
      if(cmd[2]) {
	int handle=cmd[3];
	cmd[1] = 0xB; // open stream
	cmd[2] = handle;
	bt_send_cmd(cmd);
	bt_mode = 1;
      }
      break;
  default:
    break;
    }
  }
}

long key_avail ()
{
  if(!terminal_prepped) prep_terminal();

  if(bt_mode) {
    return bt_avail();
  } else {
    if(bt_avail())
      do_bluetooth();
    return 0;
  }
}

Cell getkey()
{
  int key;

  if(!terminal_prepped) prep_terminal();

  if(needs_update) {
    display_update();
    needs_update = 0;
  }

  while(!key_avail());

  return bt_getkey();
}

void emit_char(char x)
{
  if(!terminal_prepped) prep_terminal();
  display_char(x);
  if(x == '\n') {
    display_update();
    needs_update = 0;
  } else
    needs_update = 1;
  bt_send(&x, 1);
}

void type_chars(char *addr, unsigned int l)
{
  int i;
  for(i=0; i<l; i++)
    emit_char(addr[i]);
}