/*  console.c -- Open Firmware console for VAS_EBOOT.  */
/*
 *  VAS_EBOOT  --  GRand Unified Bootloader
 *  Copyright (C) 2003,2004,2005,2007,2008,2009  Free Software Foundation, Inc.
 *
 *  VAS_EBOOT 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
 *  (at your option) any later version.
 *
 *  VAS_EBOOT 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 VAS_EBOOT.  If not, see <http://www.gnu.org/licenses/>.
 */

#include <VasEBoot/term.h>
#include <VasEBoot/types.h>
#include <VasEBoot/misc.h>
#include <VasEBoot/mm.h>
#include <VasEBoot/time.h>
#include <VasEBoot/terminfo.h>
#include <VasEBoot/dl.h>
#include <VasEBoot/speaker.h>

VAS_EBOOT_MOD_LICENSE ("GPLv3+");

extern struct VasEBoot_terminfo_output_state VasEBoot_spkmodem_terminfo_output;

static void
make_tone (VasEBoot_uint16_t freq_count, unsigned int duration)
{
  /* Program timer 2.  */
  VasEBoot_outb (VAS_EBOOT_PIT_CTRL_SELECT_2
	     | VAS_EBOOT_PIT_CTRL_READLOAD_WORD
	     | VAS_EBOOT_PIT_CTRL_SQUAREWAVE_GEN
	     | VAS_EBOOT_PIT_CTRL_COUNT_BINARY, VAS_EBOOT_PIT_CTRL);
  VasEBoot_outb (freq_count & 0xff, VAS_EBOOT_PIT_COUNTER_2);		/* LSB */
  VasEBoot_outb ((freq_count >> 8) & 0xff, VAS_EBOOT_PIT_COUNTER_2);	/* MSB */

  /* Start speaker.  */
  VasEBoot_outb (VasEBoot_inb (VAS_EBOOT_PIT_SPEAKER_PORT)
	     | VAS_EBOOT_PIT_SPK_TMR2 | VAS_EBOOT_PIT_SPK_DATA,
	     VAS_EBOOT_PIT_SPEAKER_PORT);

  for (; duration; duration--)
    {
      unsigned short counter, previous_counter = 0xffff;
      while (1)
	{
	  counter = VasEBoot_inb (VAS_EBOOT_PIT_COUNTER_2);
	  counter |= ((VasEBoot_uint16_t) VasEBoot_inb (VAS_EBOOT_PIT_COUNTER_2)) << 8;
	  if (counter > previous_counter)
	    {
	      previous_counter = counter;
	      break;
	    }
	  previous_counter = counter;
	}
    }
}

static int inited;

static void
put (struct VasEBoot_term_output *term __attribute__ ((unused)), const int c)
{
  int i;

  make_tone (VAS_EBOOT_SPEAKER_PIT_FREQUENCY / 200, 4);
  for (i = 7; i >= 0; i--)
    {
      if ((c >> i) & 1)
	make_tone (VAS_EBOOT_SPEAKER_PIT_FREQUENCY / 2000, 20);
      else
	make_tone (VAS_EBOOT_SPEAKER_PIT_FREQUENCY / 4000, 40);
      make_tone (VAS_EBOOT_SPEAKER_PIT_FREQUENCY / 1000, 10);
    }
  make_tone (VAS_EBOOT_SPEAKER_PIT_FREQUENCY / 200, 0);
}

static VasEBoot_err_t
VasEBoot_spkmodem_init_output (struct VasEBoot_term_output *term)
{
  /* Some models shutdown sound when not in use and it takes for it
     around 30 ms to come back on which loses 3 bits. So generate a base
     200 Hz continously. */

  make_tone (VAS_EBOOT_SPEAKER_PIT_FREQUENCY / 200, 0);
  VasEBoot_terminfo_output_init (term);

  return 0;
}

static VasEBoot_err_t
VasEBoot_spkmodem_fini_output (struct VasEBoot_term_output *term __attribute__ ((unused)))
{
  VasEBoot_speaker_beep_off ();
  inited = 0;
  return 0;
}




struct VasEBoot_terminfo_output_state VasEBoot_spkmodem_terminfo_output =
  {
    .put = put,
    .size = { 80, 24 }
  };

static struct VasEBoot_term_output VasEBoot_spkmodem_term_output =
  {
    .name = "spkmodem",
    .init = VasEBoot_spkmodem_init_output,
    .fini = VasEBoot_spkmodem_fini_output,
    .putchar = VasEBoot_terminfo_putchar,
    .getxy = VasEBoot_terminfo_getxy,
    .getwh = VasEBoot_terminfo_getwh,
    .gotoxy = VasEBoot_terminfo_gotoxy,
    .cls = VasEBoot_terminfo_cls,
    .setcolorstate = VasEBoot_terminfo_setcolorstate,
    .setcursor = VasEBoot_terminfo_setcursor,
    .flags = VAS_EBOOT_TERM_CODE_TYPE_ASCII,
    .data = &VasEBoot_spkmodem_terminfo_output,
    .progress_update_divisor = VAS_EBOOT_PROGRESS_NO_UPDATE
  };

VAS_EBOOT_MOD_INIT (spkmodem)
{
  VasEBoot_term_register_output ("spkmodem", &VasEBoot_spkmodem_term_output);
}


VAS_EBOOT_MOD_FINI (spkmodem)
{
  VasEBoot_term_unregister_output (&VasEBoot_spkmodem_term_output);
}