#include <stdio.h>
#include <stdlib.h>

#include <string.h>
#include <stdint.h>

#include "hardware.h"
#include "hdd.h"


static void emptyIT()
{
  return;
}


static void hddIT()
{
  printf("IT!\n");
  return;
}

uint16_t tailleSec()
{
  _out(HDA_CMDREG, CMD_DSKINFO);
  
  uint16_t sec;

  sec = _in(HDA_DATAREGS+4) << 8;
  sec |= _in(HDA_DATAREGS+5);

  return sec;
}

void dump_sector(uint16_t secteur,
		 uint16_t piste)
{
  printf("SEEK : %d, %d\n", secteur, piste);
  _out(HDA_DATAREGS, (piste >> 8) & 0xFF);
  _out(HDA_DATAREGS+1, piste & 0xFF);

  _out(HDA_DATAREGS+2, (secteur >> 8) & 0xFF);
  _out(HDA_DATAREGS+3, secteur & 0xFF);

  _out(HDA_CMDREG, CMD_SEEK);

  printf("attente\n");
  _sleep(HDA_IRQ);

  printf("Retour :\n");
  uint8_t data = _in(HDA_DATAREGS);

  printf("%d\n", data);

  /* Lire un secteur */
  _out(HDA_DATAREGS, 1);
  _out(HDA_CMDREG, CMD_READ);
  
  _sleep(HDA_IRQ);

  int tSec = tailleSec();

  int i;
  for(i=0;i<tSec;i++)
    printf("%x ", *(MASTERBUFFER+i));

  printf("\n");
  
}


int main(int argc, char *argv[])
{
  unsigned int i;

  uint16_t secteur=0, piste=0;

  if ( argc < 5 )
    {
      printf("Utilisation : %s -s # -p #\n", argv[0]);
      exit(1);
    }

  /* Lecture des arguments */
  for(i=1;i<argc;i+=2)
    {
      if ( strcmp(argv[i], "-s") == 0 )
	secteur = atoi(argv[i+1]);

      else if ( strcmp(argv[i], "-p") == 0 )
	piste = atoi(argv[i+1]);

      else
	{
	  printf("Argument %s non reconnu.\n", argv[i]);
	  exit(1);
	}
    }

  /* init hardware */
  if(initHardware("hardware.ini") == 0) {
    fprintf(stderr, "Error in hardware initialization\n");
    exit(EXIT_FAILURE);
  }

  /* Interreupt handlers */
  for(i=0; i<16; i++)
    IRQVECTOR[i] = emptyIT;

  IRQVECTOR[HDA_IRQ] = hddIT;

  /* Allows all IT */
  _mask(1);

  dump_sector(secteur, piste);
  
  return EXIT_SUCCESS;
}