URL https://opencores.org/ocsvn/or1k/or1k/trunk

Subversion Repositories or1k

[/] [or1k/] [branches/] [stable_0_2_x/] [or1ksim/] [peripheral/] [atadevice.c] - Blame information for rev 997

Go to most recent revision | Details | Compare with Previous | View Log


/*
    atadevice.c -- ATA Device simulation
    Simulates a harddisk, using a local streams.
    Copyright (C) 2002 Richard Herveille, rherveille@opencores.org
 
    This file is part of OpenRISC 1000 Architectural Simulator
 
    This program 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., 675 Mass Ave, Cambridge, MA 02139, USA.
*/
 
#include "abstract.h"
#include "sched.h"
 
#include "messages.h"
#include "atadevice.h"
#include "atacmd.h"
#include "sim-config.h"
#include "atadevice_cmdi.h"
 
#include <string.h>
#include <stdarg.h>
 
/*
 mandatory commands:
 - execute device diagnostics       (done)
 - flush cache
 - identify device                  (done)
 - initialize device parameters     (done)
 - read dma
 - read multiple
 - read sector(s)                   (done)
 - read verify sector(s)
 - seek
 - set features
 - set multiple mode
 - write dma
 - write multiple
 - write sector(s)
 
 
 optional commands:
 - download microcode
 - nop
 - read buffer
 - write buffer
 
 
 prohibited commands:
 - device reset
*/
 
 
/*
  D E V I C E S _ I N I T
*/
void ata_devices_init(ata_devices *devices, const char *filename0, const char *filename1)
{
  ata_device_init(&devices->device0, 0, filename0);
 
  if (devices->device0.type)
    ata_device_init(&devices->device1, ATA_DHR_DEV, filename1);
  else
    ata_device_init(&devices->device1,           0, filename1);
}
 
 
void ata_device_init(ata_device *device, int dev, const char *filename)
{
  /* set DeviceID                                                     */
  device->settings.dev = dev;
 
  /* generate stream for hd_simulation                                */
  switch(device->type)
  {
    case TYPE_NO_CONNECT:
      MSG_NOTE("ata_device, using type NO_CONNECT.");
      device->stream = NULL;
      break;
 
    case TYPE_FILE:
      MSG_NOTE("ata_device, using device type FILE.");
      device->stream = open_file(&device->size, filename);
      break;
 
    case TYPE_LOCAL:
      MSG_NOTE("ata_device, using device type LOCAL.");
      device->stream = open_local();
      break;
 
    default:
      MSG_FATAL("ata_device, illegal device-type.");
      MSG_EMPTY("defaulting to type NO_CONNECT.");
      device->stream = NULL;
      break;
  }
}
 
/* Use a file to simulate a hard-disk                                 */
FILE *open_file(unsigned long *size, const char *filename)
{
   FILE *fp;
   unsigned long  n;
 
   // TODO:
 
   /* check if a file with name 'filename' already exists             */
   if ( !(fp = fopen(filename, "rb+")) )
     if ( !(fp = fopen(filename, "wb+")) )
     {
       MSG_FATAL( strcat("ata_open_file, cannot open hd-file ", filename) );
       return NULL;
     }
     else
     {
       /* TODO create a file 'size' large */
       /* create a file 'size' large                                  */
       MSG_NOTE("ata_device; generating a new hard disk file.");
       MSG_EMPTY("This may take a while, depending on the requested size.");
       for (n=0; n < (*size << 20); n++)
         fputc(0, fp);
     }
   else /* file already exist                                         */
     fprintf(stderr, "file %s already exists. Using existing file.\n", filename);
 
 
   ata_device_debug(1, "requested filesize was: %d (MBytes).\n", *size);
 
   /* get the size of the file. This is also the size of the harddisk*/
   fseek(fp, 0, SEEK_END);
   *size = ftell(fp);
 
   ata_device_debug(1, "actual filesize is: %d (MBytes).\n", *size >> 20);
 
   return fp;
}
 
 
/* Use a the local filesystem as a hard-disk                          */
FILE *open_local(void)
{
 // TODO:
 MSG_WARNING("ata_device; device type LOCAL is not supported yet.");
 MSG_EMPTY("defaulting to device type NO_CONNECT.");
 return NULL;
}
 
 
 
 
/*
  D E V I C E S _ H W _ R E S E T
*/
/* power-on and hardware reset                                        */
void ata_devices_hw_reset(ata_devices *devices, int reset_signal)
{
  /* display debug information                                        */
  ata_device_debug(2, "ata_devices_hw_reset.\n");
 
  /* find device 0                                                    */
  if ( (devices->device0.stream) && (devices->device1.stream) )
  {
    /* this one is simple, device0 is device0                         */
 
    /* 1) handle device1 first                                        */
    ata_device_hw_reset(&devices->device1, reset_signal, \
                        1, \ /* assert dasp, this is device1          */
                        0, \ /* negate pdiag input, no more devices   */
                        0);  /* negate dasp input, no more devices    */
 
    /* 2) Then handle device0                                         */
    ata_device_hw_reset(&devices->device0, reset_signal, \
                        0,                              \
                        devices->device1.sigs.pdiago,        \
                        devices->device1.sigs.daspo);
  }
  else if (devices->device0.stream)
  {
    /* device0 is device0, there's no device1                         */
    ata_device_hw_reset(&devices->device0, reset_signal, \
                        0, \ /* negate dasp, this is device0          */
                        0, \ /* negate pdiag input, there's no device1*/
                        0);  /* negate dasp input, there's no device1 */
  }
  else if (devices->device1.stream)
  {
    /* device1 is (logical) device0, there's no (physical) device0    */
    ata_device_hw_reset(&devices->device1, reset_signal, \
                        0, \ /* negate dasp, this is device0          */
                        0, \ /* negate pdiag input, there's no device1*/
                        0);  /* negate dasp input, there's no device1 */
  }
  else
  {
    /* no devices connected                                           */
    ata_device_debug(1, "ata_device_hw_reset, no devices connected.\n");
  }
}
 
void ata_device_hw_reset(ata_device *device, int reset_signal, \
  int daspo, int pdiagi, int daspi)
{
    /* check ata-device state                                         */
    if (device->settings.state == ATA_STATE_HW_RST)
    {
      if (!reset_signal)
      {
        /* hardware reset finished                                    */
 
        /* set sectors_per_track & heads_per_cylinders                */
        device->settings.sectors_per_track = SECTORS;
        device->settings.heads_per_cylinder = HEADS;
 
        /* set device1 input signals                                  */
        device->sigs.pdiagi = pdiagi;
        device->sigs.daspi  = daspi;
 
        ata_execute_device_diagnostics_cmd(device);
 
        /* clear busy bit                                             */
        device->regs.status &= ~ATA_SR_BSY;
 
        /* set DRDY bit, when not a PACKET device                     */
        if (!device->packet)
            device->regs.status |= ATA_SR_DRDY;
 
        /* set new state                                              */
        device->settings.state = ATA_STATE_IDLE;
      }
    }
    else
      if (reset_signal)
      {
        /* hardware reset signal asserted, stop what we are doing     */
 
        /* negate bus signals                                         */
        device->sigs.iordy  = 0;
        device->sigs.intrq  = 0;
        device->sigs.dmarq  = 0;
        device->sigs.pdiago = 0;
        device->sigs.daspo  = daspo;
 
        /* set busy bit                                               */
        device->regs.status |= ATA_SR_BSY;
        PRINTF("setting status register BSY 0x%2X\n", device->regs.status);
 
        /* set new state                                              */
        device->settings.state = ATA_STATE_HW_RST;
      }
}
 
 
/*
  D E V I C E S _ D O _ C O N T R O L _ R E G I S T E R
 
  Handles - software reset
          - Interrupt enable bit
*/
void ata_device_do_control_register(ata_device *device)
{
    /* TODO respond to new values of nIEN */
    /* if device not selected, respond to new values of nIEN & SRST */
 
  /* check if SRST bit is set                                         */
  if (device->regs.device_control & ATA_DCR_RST)
  {
    if (device->settings.state == ATA_STATE_IDLE)
    {   /* start software reset                                       */
        /* negate bus signals                                         */
        device->sigs.pdiago = 0;
        device->sigs.intrq  = 0;
        device->sigs.iordy  = 0;
        device->sigs.dmarq  = 0;
 
        /* set busy bit                                               */
        device->regs.status |= ATA_SR_BSY;
 
        /* set new state                                              */
        device->settings.state = ATA_STATE_SW_RST;
 
        /* display debug information                                  */
        ata_device_debug(2, "ata_device_sw_reset initiated.\n");
    }
  }
  else if (device->settings.state == ATA_STATE_SW_RST)
  {   /* are we doing a software reset ??                             */
      /* SRST bit cleared, end of software reset                      */
 
      /*execute device diagnostics                                    */
      ata_execute_device_diagnostics_cmd(device);
 
      /* clear busy bit                                               */
      device->regs.status &= ~ATA_SR_BSY;
 
      /* set DRDY bit, when not a PACKET device                       */
      if (!device->packet)
        device->regs.status |= ATA_SR_DRDY;
 
      /* set new state                                                */
      device->settings.state = ATA_STATE_IDLE;
 
      /* display debug information                                    */
      ata_device_debug(2, "ata_device_sw_reset done.\n");
  }
  /*
  <else> We are doing a hardware reset (or similar)
         ignore command
  */
}
 
 
/*
  D E V I C E S _ D O _ C O M M A N D _ R E G I S T E R
*/
void ata_device_do_command_register(ata_device *device)
{
  /* check BSY & DRQ                                                  */
  if ( (device->regs.status & ATA_SR_BSY) || (device->regs.status & ATA_SR_DRQ) )
     if (device->regs.command != DEVICE_RESET)
        MSG_WARNING("ata_device_write, writing a command while BSY or DRQ asserted.");
 
  /* check if device selected                                         */
  if ( (device->regs.device_head & ATA_DHR_DEV) == device->settings.dev )
      ata_device_execute_cmd(device);
  else
  {
      /* if not selected, only respond to EXECUTE DEVICE DIAGNOSTICS  */
      if (device->regs.command == EXECUTE_DEVICE_DIAGNOSTICS)
          ata_device_execute_cmd(device);
  }
}
 
 
/*
  D E V I C E S _ R E A D
*/
/* Read from devices                                                  */
short ata_devices_read(ata_devices *devices, char adr)
{
    ata_device *device;
 
    /* check for no connected devices                                 */
    if ( (!devices->device0.stream) && (!devices->device1.stream) )
        MSG_ERROR("ata_devices_read, no ata devices connected.");
    else
    {
      /* check if both device0 and device1 are connected              */
      if ( (devices->device0.stream) && (devices->device1.stream) )
      {
          /* get the current active device                            */
          if (devices->device1.regs.device_head & ATA_DHR_DEV)
              device = &devices->device1;
          else
              device = &devices->device0;
      }
      else
      {
          /* only one device connected                                */
          if (devices->device1.stream)
              device = &devices->device1;
          else
              device = &devices->device0;
      }
 
      /* return data provided by selected device                      */
      switch (adr) {
        case ATA_ASR :
          ata_device_debug(4, "alternate_status register read\n");
          if ( (device->regs.device_head & ATA_DHR_DEV) ==  device->settings.dev )
              return device -> regs.status;
          else
          {
              ata_device_debug(2, "device0 responds for device1, asr = 0x00\n");
              return 0; // return 0 when device0 responds for device1
          }
 
        case ATA_CHR :
          ata_device_debug(4, "cylinder_high register read, value = 0x%02X\n", \
                 device->regs.cylinder_high);
          return device -> regs.cylinder_high;
 
        case ATA_CLR :
          ata_device_debug(4, "cylinder_low register read, value = 0x%02X\n", \
                 device->regs.cylinder_low);
          return device -> regs.cylinder_low;
 
        case ATA_DR  :
          ata_device_debug(4, "data register read, value = 0x%04X, cnt = %3d\n", \
                 device->settings.dbuf[device->settings.dbuf_cnt], device->settings.dbuf_cnt);
          return device -> settings.dbuf[device->settings.dbuf_cnt++];
 
        case ATA_DHR :
          ata_device_debug(4, "device_head register read, value = 0x%02X\n", \
                 device->regs.device_head);
          return device -> regs.device_head;
 
        case ATA_ERR :
          ata_device_debug(4, "error register read, value = 0x%02X\n", \
                 device->regs.error);
          return device -> regs.error;
 
        case ATA_SCR :
          ata_device_debug(4, "sectorcount register read, value = 0x%02X\n", \
                 device->regs.sector_count);
          return device -> regs.sector_count;
 
        case ATA_SNR :
          ata_device_debug(4, "sectornumber register read, value = 0x%02X\n", \
                 device->regs.sector_number);
          return device -> regs.sector_number;
 
        case ATA_SR  :
          ata_device_debug(4, "status register read\n");
          if ( (device->regs.device_head & ATA_DHR_DEV) ==  device->settings.dev)
              return device -> regs.status;
          else
          {
              ata_device_debug(2, "device0 responds for device1, sr = 0x00\n");
              return 0; // return 0 when device0 responds for device1
          }
 
//        case ATA_DA   :
//          return device -> regs.status;
      }
    }
}
 
 
/*
  D E V I C E S _ W R I T E
*/
/* Write to devices                                                   */
void ata_devices_write(ata_devices *devices, char adr, short value)
{
    ata_device *device;
 
    /* check for no connected devices                                 */
    if (!devices->device0.stream && !devices->device1.stream)
        MSG_ERROR("ata_devices_write, no ata devices connected.");
    else
    {
      /* first device                                                 */
      if (devices->device0.stream)
          ata_device_write(&devices->device0, adr, value);
 
      /* second device                                                */
      if (devices->device1.stream)
          ata_device_write(&devices->device1, adr, value);
    }
}
 
/* write to a single device                                           */
void ata_device_write(ata_device *device, char adr, short value)
{
    switch (adr) {
        case ATA_CR  :
            /*display debug information                               */
            ata_device_debug(4, "command register written, value = 0x%02X\n", value);
 
            device->regs.command = value;
 
            /* check command register settings and execute command    */
            ata_device_do_command_register(device);
            break;
 
 
        case ATA_CHR :
            /*display debug information                               */
            ata_device_debug(4, "cylinder high register written, value = 0x%02X\n", value);
 
            device->regs.cylinder_high = value;
            break;
 
        case ATA_CLR :
            /*display debug information                               */
            ata_device_debug(4, "cylinder low register written, value = 0x%02X\n", value);
 
            device->regs.cylinder_low = value;
            break;
 
        case ATA_DR :
            /*display debug information                               */
            ata_device_debug(4, "data register written, value = 0x%04X\n", value);
 
            device->regs.dataport_i = value;
            break;
 
        case ATA_DCR :
            /*display debug information                               */
            ata_device_debug(4, "device control register written, value = 0x%02X\n", value);
 
            device->regs.device_control = value;
            ata_device_do_control_register(device);
            break;
 
        case ATA_DHR :
            /*display debug information                               */
            ata_device_debug(4, "device head register written, value = 0x%02X\n", value);
 
            device->regs.device_head = value;
            break;
 
        case ATA_FR  :
            /*display debug information                               */
            ata_device_debug(4, "features register written, value = 0x%02X\n", value);
 
            device->regs.features = value;
            break;
 
        case ATA_SCR :
            /*display debug information                               */
            ata_device_debug(4, "sectorcount register written, value = 0x%02X\n", value);
 
            device->regs.sector_count = value;
            break;
 
        case ATA_SNR :
            /*display debug information                               */
            ata_device_debug(4, "sectornumber register written, value = 0x%02X\n", value);
 
            device->regs.sector_number = value;
            break;
 
    } //endcase
}
 
 
/* --------------------------                                         */
/* -- print debug messages --                                         */
/* --------------------------                                         */
int ata_device_debug(int lvl, char *format, ...)
{
  va_list ap;
 
  va_start(ap, format);
 
  if (ATA_DEVICE_DEBUG_LVL >= lvl)
  {
    fprintf(stderr, "ata_device_debug: ");
    vfprintf(stderr, format, ap);
  }
 
  va_end(ap);
  return 0;
}

Browse

Tools

Subversion Repositories or1k

[/] [or1k/] [branches/] [stable_0_2_x/] [or1ksim/] [peripheral/] [atadevice.c] - Blame information for rev 997

Line No.	Rev	Author	Line
1	876	rherveille	`/*`
2			`atadevice.c -- ATA Device simulation`
3			`Simulates a harddisk, using a local streams.`
4			`Copyright (C) 2002 Richard Herveille, rherveille@opencores.org`
5
6			`This file is part of OpenRISC 1000 Architectural Simulator`
7
8			`This program is free software; you can redistribute it and/or modify`
9			`it under the terms of the GNU General Public License as published by`
10			`the Free Software Foundation; either version 2 of the License, or`
11			`(at your option) any later version`
12
13			`This program is distributed in the hope that it will be useful,`
14			`but WITHOUT ANY WARRANTY; without even the implied warranty of`
15			`MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the`
16			`GNU General Public License for more details.`
17
18			`You should have received a copy of the GNU General Public License`
19			`along with this program; if not, write to the Free Software`
20			`Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.`
21			`*/`
22
23			`#include "abstract.h"`
24			`#include "sched.h"`
25
26			`#include "messages.h"`
27			`#include "atadevice.h"`
28			`#include "atacmd.h"`
29			`#include "sim-config.h"`
30			`#include "atadevice_cmdi.h"`
31
32			`#include <string.h>`
33			`#include <stdarg.h>`
34
35			`/*`
36			`mandatory commands:`
37	919	rherveille	`- execute device diagnostics (done)`
38	876	rherveille	`- flush cache`
39	919	rherveille	`- identify device (done)`
40			`- initialize device parameters (done)`
41	876	rherveille	`- read dma`
42			`- read multiple`
43	919	rherveille	`- read sector(s) (done)`
44	876	rherveille	`- read verify sector(s)`
45			`- seek`
46			`- set features`
47			`- set multiple mode`
48			`- write dma`
49			`- write multiple`
50			`- write sector(s)`
51
52
53			`optional commands:`
54			`- download microcode`
55			`- nop`
56			`- read buffer`
57			`- write buffer`
58
59
60			`prohibited commands:`
61			`- device reset`
62			`*/`
63
64
65			`/*`
66			`D E V I C E S _ I N I T`
67			`*/`
68			`void ata_devices_init(ata_devices devices, const char filename0, const char *filename1)`
69			`{`
70			`ata_device_init(&devices->device0, 0, filename0);`
71
72			`if (devices->device0.type)`
73			`ata_device_init(&devices->device1, ATA_DHR_DEV, filename1);`
74			`else`
75			`ata_device_init(&devices->device1, 0, filename1);`
76			`}`
77
78
79			`void ata_device_init(ata_device device, int dev, const char filename)`
80			`{`
81			`/* set DeviceID */`
82			`device->settings.dev = dev;`
83
84			`/* generate stream for hd_simulation */`
85			`switch(device->type)`
86			`{`
87			`case TYPE_NO_CONNECT:`
88			`MSG_NOTE("ata_device, using type NO_CONNECT.");`
89			`device->stream = NULL;`
90			`break;`
91
92			`case TYPE_FILE:`
93			`MSG_NOTE("ata_device, using device type FILE.");`
94			`device->stream = open_file(&device->size, filename);`
95			`break;`
96
97			`case TYPE_LOCAL:`
98			`MSG_NOTE("ata_device, using device type LOCAL.");`
99			`device->stream = open_local();`
100			`break;`
101
102			`default:`
103			`MSG_FATAL("ata_device, illegal device-type.");`
104			`MSG_EMPTY("defaulting to type NO_CONNECT.");`
105			`device->stream = NULL;`
106			`break;`
107			`}`
108			`}`
109
110			`/* Use a file to simulate a hard-disk */`
111			`FILE open_file(unsigned long size, const char *filename)`
112			`{`
113			`FILE *fp;`
114			`unsigned long n;`
115
116			`// TODO:`
117
118			`/* check if a file with name 'filename' already exists */`
119			`if ( !(fp = fopen(filename, "rb+")) )`
120			`if ( !(fp = fopen(filename, "wb+")) )`
121			`{`
122			`MSG_FATAL( strcat("ata_open_file, cannot open hd-file ", filename) );`
123			`return NULL;`
124			`}`
125			`else`
126			`{`
127			`/* TODO create a file 'size' large */`
128			`/* create a file 'size' large */`
129			`MSG_NOTE("ata_device; generating a new hard disk file.");`
130			`MSG_EMPTY("This may take a while, depending on the requested size.");`
131			`for (n=0; n < (*size << 20); n++)`
132			`fputc(0, fp);`
133			`}`
134			`else /* file already exist */`
135			`fprintf(stderr, "file %s already exists. Using existing file.\n", filename);`
136
137
138			`ata_device_debug(1, "requested filesize was: %d (MBytes).\n", *size);`
139
140			`/* get the size of the file. This is also the size of the harddisk*/`
141			`fseek(fp, 0, SEEK_END);`
142			`*size = ftell(fp);`
143
144			`ata_device_debug(1, "actual filesize is: %d (MBytes).\n", *size >> 20);`
145
146			`return fp;`
147			`}`
148
149
150			`/* Use a the local filesystem as a hard-disk */`
151			`FILE *open_local(void)`
152			`{`
153			`// TODO:`
154			`MSG_WARNING("ata_device; device type LOCAL is not supported yet.");`
155			`MSG_EMPTY("defaulting to device type NO_CONNECT.");`
156			`return NULL;`
157			`}`
158
159
160
161
162			`/*`
163			`D E V I C E S _ H W _ R E S E T`
164			`*/`
165			`/* power-on and hardware reset */`
166			`void ata_devices_hw_reset(ata_devices *devices, int reset_signal)`
167			`{`
168			`/* display debug information */`
169	919	rherveille	`ata_device_debug(2, "ata_devices_hw_reset.\n");`
170	876	rherveille
171			`/* find device 0 */`
172			`if ( (devices->device0.stream) && (devices->device1.stream) )`
173			`{`
174			`/* this one is simple, device0 is device0 */`
175
176			`/* 1) handle device1 first */`
177			`ata_device_hw_reset(&devices->device1, reset_signal, \`
178			`1, \ /* assert dasp, this is device1 */`
179			`0, \ /* negate pdiag input, no more devices */`
180			`0); /* negate dasp input, no more devices */`
181
182			`/* 2) Then handle device0 */`
183			`ata_device_hw_reset(&devices->device0, reset_signal, \`
184			`0, \`
185			`devices->device1.sigs.pdiago, \`
186			`devices->device1.sigs.daspo);`
187			`}`
188			`else if (devices->device0.stream)`
189			`{`
190			`/* device0 is device0, there's no device1 */`
191			`ata_device_hw_reset(&devices->device0, reset_signal, \`
192			`0, \ /* negate dasp, this is device0 */`
193			`0, \ /* negate pdiag input, there's no device1*/`
194			`0); /* negate dasp input, there's no device1 */`
195			`}`
196			`else if (devices->device1.stream)`
197			`{`
198			`/* device1 is (logical) device0, there's no (physical) device0 */`
199			`ata_device_hw_reset(&devices->device1, reset_signal, \`
200			`0, \ /* negate dasp, this is device0 */`
201			`0, \ /* negate pdiag input, there's no device1*/`
202			`0); /* negate dasp input, there's no device1 */`
203			`}`
204			`else`
205			`{`
206			`/* no devices connected */`
207			`ata_device_debug(1, "ata_device_hw_reset, no devices connected.\n");`
208			`}`
209			`}`
210
211			`void ata_device_hw_reset(ata_device *device, int reset_signal, \`
212			`int daspo, int pdiagi, int daspi)`
213			`{`
214			`/* check ata-device state */`
215			`if (device->settings.state == ATA_STATE_HW_RST)`
216			`{`
217			`if (!reset_signal)`
218			`{`
219			`/* hardware reset finished */`
220
221			`/* set sectors_per_track & heads_per_cylinders */`
222			`device->settings.sectors_per_track = SECTORS;`
223			`device->settings.heads_per_cylinder = HEADS;`
224
225			`/* set device1 input signals */`
226			`device->sigs.pdiagi = pdiagi;`
227			`device->sigs.daspi = daspi;`
228
229			`ata_execute_device_diagnostics_cmd(device);`
230
231			`/* clear busy bit */`
232			`device->regs.status &= ~ATA_SR_BSY;`
233
234			`/* set DRDY bit, when not a PACKET device */`
235			`if (!device->packet)`
236			`device->regs.status \|= ATA_SR_DRDY;`
237
238			`/* set new state */`
239			`device->settings.state = ATA_STATE_IDLE;`
240			`}`
241			`}`
242			`else`
243			`if (reset_signal)`
244			`{`
245			`/* hardware reset signal asserted, stop what we are doing */`
246
247			`/* negate bus signals */`
248			`device->sigs.iordy = 0;`
249			`device->sigs.intrq = 0;`
250			`device->sigs.dmarq = 0;`
251			`device->sigs.pdiago = 0;`
252			`device->sigs.daspo = daspo;`
253
254			`/* set busy bit */`
255			`device->regs.status \|= ATA_SR_BSY;`
256	997	markom	`PRINTF("setting status register BSY 0x%2X\n", device->regs.status);`
257	876	rherveille
258			`/* set new state */`
259			`device->settings.state = ATA_STATE_HW_RST;`
260			`}`
261			`}`
262
263
264			`/*`
265			`D E V I C E S _ D O _ C O N T R O L _ R E G I S T E R`
266
267			`Handles - software reset`
268			`- Interrupt enable bit`
269			`*/`
270			`void ata_device_do_control_register(ata_device *device)`
271			`{`
272			`/* TODO respond to new values of nIEN */`
273			`/* if device not selected, respond to new values of nIEN & SRST */`
274
275			`/* check if SRST bit is set */`
276			`if (device->regs.device_control & ATA_DCR_RST)`
277			`{`
278			`if (device->settings.state == ATA_STATE_IDLE)`
279			`{ /* start software reset */`
280			`/* negate bus signals */`
281			`device->sigs.pdiago = 0;`
282			`device->sigs.intrq = 0;`
283			`device->sigs.iordy = 0;`
284			`device->sigs.dmarq = 0;`
285
286			`/* set busy bit */`
287			`device->regs.status \|= ATA_SR_BSY;`
288
289			`/* set new state */`
290			`device->settings.state = ATA_STATE_SW_RST;`
291
292			`/* display debug information */`
293			`ata_device_debug(2, "ata_device_sw_reset initiated.\n");`
294			`}`
295			`}`
296			`else if (device->settings.state == ATA_STATE_SW_RST)`
297			`{ /* are we doing a software reset ?? */`
298			`/* SRST bit cleared, end of software reset */`
299
300			`/execute device diagnostics /`
301			`ata_execute_device_diagnostics_cmd(device);`
302
303			`/* clear busy bit */`
304			`device->regs.status &= ~ATA_SR_BSY;`
305
306			`/* set DRDY bit, when not a PACKET device */`
307			`if (!device->packet)`
308			`device->regs.status \|= ATA_SR_DRDY;`
309
310			`/* set new state */`
311			`device->settings.state = ATA_STATE_IDLE;`
312
313			`/* display debug information */`
314			`ata_device_debug(2, "ata_device_sw_reset done.\n");`
315			`}`
316			`/*`
317			`<else> We are doing a hardware reset (or similar)`
318			`ignore command`
319			`*/`
320			`}`
321
322
323			`/*`
324			`D E V I C E S _ D O _ C O M M A N D _ R E G I S T E R`
325			`*/`
326			`void ata_device_do_command_register(ata_device *device)`
327			`{`
328			`/* check BSY & DRQ */`
329			`if ( (device->regs.status & ATA_SR_BSY) \|\| (device->regs.status & ATA_SR_DRQ) )`
330			`if (device->regs.command != DEVICE_RESET)`
331			`MSG_WARNING("ata_device_write, writing a command while BSY or DRQ asserted.");`
332
333			`/* check if device selected */`
334			`if ( (device->regs.device_head & ATA_DHR_DEV) == device->settings.dev )`
335			`ata_device_execute_cmd(device);`
336			`else`
337			`{`
338			`/* if not selected, only respond to EXECUTE DEVICE DIAGNOSTICS */`
339			`if (device->regs.command == EXECUTE_DEVICE_DIAGNOSTICS)`
340			`ata_device_execute_cmd(device);`
341			`}`
342			`}`
343
344
345			`/*`
346			`D E V I C E S _ R E A D`
347			`*/`
348			`/* Read from devices */`
349			`short ata_devices_read(ata_devices *devices, char adr)`
350			`{`
351			`ata_device *device;`
352
353			`/* check for no connected devices */`
354			`if ( (!devices->device0.stream) && (!devices->device1.stream) )`
355	919	rherveille	`MSG_ERROR("ata_devices_read, no ata devices connected.");`
356	876	rherveille	`else`
357			`{`
358			`/* check if both device0 and device1 are connected */`
359			`if ( (devices->device0.stream) && (devices->device1.stream) )`
360			`{`
361			`/* get the current active device */`
362			`if (devices->device1.regs.device_head & ATA_DHR_DEV)`
363			`device = &devices->device1;`
364			`else`
365			`device = &devices->device0;`
366			`}`
367			`else`
368			`{`
369			`/* only one device connected */`
370			`if (devices->device1.stream)`
371			`device = &devices->device1;`
372			`else`
373			`device = &devices->device0;`
374			`}`
375
376			`/* return data provided by selected device */`
377			`switch (adr) {`
378			`case ATA_ASR :`
379	919	rherveille	`ata_device_debug(4, "alternate_status register read\n");`
380	876	rherveille	`if ( (device->regs.device_head & ATA_DHR_DEV) == device->settings.dev )`
381			`return device -> regs.status;`
382			`else`
383			`{`
384			`ata_device_debug(2, "device0 responds for device1, asr = 0x00\n");`
385			`return 0; // return 0 when device0 responds for device1`
386			`}`
387
388			`case ATA_CHR :`
389	919	rherveille	`ata_device_debug(4, "cylinder_high register read, value = 0x%02X\n", \`
390	876	rherveille	`device->regs.cylinder_high);`
391			`return device -> regs.cylinder_high;`
392
393			`case ATA_CLR :`
394	919	rherveille	`ata_device_debug(4, "cylinder_low register read, value = 0x%02X\n", \`
395	876	rherveille	`device->regs.cylinder_low);`
396			`return device -> regs.cylinder_low;`
397
398			`case ATA_DR :`
399	919	rherveille	`ata_device_debug(4, "data register read, value = 0x%04X, cnt = %3d\n", \`
400	876	rherveille	`device->settings.dbuf[device->settings.dbuf_cnt], device->settings.dbuf_cnt);`
401			`return device -> settings.dbuf[device->settings.dbuf_cnt++];`
402
403			`case ATA_DHR :`
404	919	rherveille	`ata_device_debug(4, "device_head register read, value = 0x%02X\n", \`
405	876	rherveille	`device->regs.device_head);`
406			`return device -> regs.device_head;`
407
408			`case ATA_ERR :`
409	919	rherveille	`ata_device_debug(4, "error register read, value = 0x%02X\n", \`
410	876	rherveille	`device->regs.error);`
411			`return device -> regs.error;`
412
413			`case ATA_SCR :`
414	919	rherveille	`ata_device_debug(4, "sectorcount register read, value = 0x%02X\n", \`
415	876	rherveille	`device->regs.sector_count);`
416			`return device -> regs.sector_count;`
417
418			`case ATA_SNR :`
419	919	rherveille	`ata_device_debug(4, "sectornumber register read, value = 0x%02X\n", \`
420	876	rherveille	`device->regs.sector_number);`
421			`return device -> regs.sector_number;`
422
423			`case ATA_SR :`
424	919	rherveille	`ata_device_debug(4, "status register read\n");`
425	876	rherveille	`if ( (device->regs.device_head & ATA_DHR_DEV) == device->settings.dev)`
426			`return device -> regs.status;`
427			`else`
428			`{`
429			`ata_device_debug(2, "device0 responds for device1, sr = 0x00\n");`
430			`return 0; // return 0 when device0 responds for device1`
431			`}`
432
433			`// case ATA_DA :`
434			`// return device -> regs.status;`
435			`}`
436			`}`
437			`}`
438
439
440			`/*`
441			`D E V I C E S _ W R I T E`
442			`*/`
443			`/* Write to devices */`
444			`void ata_devices_write(ata_devices *devices, char adr, short value)`
445			`{`
446			`ata_device *device;`
447	919	rherveille
448	876	rherveille	`/* check for no connected devices */`
449			`if (!devices->device0.stream && !devices->device1.stream)`
450	919	rherveille	`MSG_ERROR("ata_devices_write, no ata devices connected.");`
451	876	rherveille	`else`
452			`{`
453			`/* first device */`
454			`if (devices->device0.stream)`
455			`ata_device_write(&devices->device0, adr, value);`
456
457			`/* second device */`
458			`if (devices->device1.stream)`
459			`ata_device_write(&devices->device1, adr, value);`
460			`}`
461			`}`
462
463			`/* write to a single device */`
464			`void ata_device_write(ata_device *device, char adr, short value)`
465			`{`
466			`switch (adr) {`
467			`case ATA_CR :`
468			`/display debug information /`
469	919	rherveille	`ata_device_debug(4, "command register written, value = 0x%02X\n", value);`
470	876	rherveille
471			`device->regs.command = value;`
472
473			`/* check command register settings and execute command */`
474			`ata_device_do_command_register(device);`
475			`break;`
476
477
478			`case ATA_CHR :`
479			`/display debug information /`
480	919	rherveille	`ata_device_debug(4, "cylinder high register written, value = 0x%02X\n", value);`
481	876	rherveille
482			`device->regs.cylinder_high = value;`
483			`break;`
484
485			`case ATA_CLR :`
486			`/display debug information /`
487	919	rherveille	`ata_device_debug(4, "cylinder low register written, value = 0x%02X\n", value);`
488	876	rherveille
489			`device->regs.cylinder_low = value;`
490			`break;`
491
492			`case ATA_DR :`
493			`/display debug information /`
494	919	rherveille	`ata_device_debug(4, "data register written, value = 0x%04X\n", value);`
495	876	rherveille
496			`device->regs.dataport_i = value;`
497			`break;`
498
499			`case ATA_DCR :`
500			`/display debug information /`
501	919	rherveille	`ata_device_debug(4, "device control register written, value = 0x%02X\n", value);`
502	876	rherveille
503			`device->regs.device_control = value;`
504			`ata_device_do_control_register(device);`
505			`break;`
506
507			`case ATA_DHR :`
508			`/display debug information /`
509	919	rherveille	`ata_device_debug(4, "device head register written, value = 0x%02X\n", value);`
510	876	rherveille
511			`device->regs.device_head = value;`
512			`break;`
513
514			`case ATA_FR :`
515			`/display debug information /`
516	919	rherveille	`ata_device_debug(4, "features register written, value = 0x%02X\n", value);`
517	876	rherveille
518			`device->regs.features = value;`
519			`break;`
520
521			`case ATA_SCR :`
522			`/display debug information /`
523	919	rherveille	`ata_device_debug(4, "sectorcount register written, value = 0x%02X\n", value);`
524	876	rherveille
525			`device->regs.sector_count = value;`
526			`break;`
527
528			`case ATA_SNR :`
529			`/display debug information /`
530	919	rherveille	`ata_device_debug(4, "sectornumber register written, value = 0x%02X\n", value);`
531	876	rherveille
532			`device->regs.sector_number = value;`
533			`break;`
534
535			`} //endcase`
536			`}`
537
538
539			`/* -------------------------- */`
540			`/* -- print debug messages -- */`
541			`/* -------------------------- */`
542			`int ata_device_debug(int lvl, char *format, ...)`
543			`{`
544			`va_list ap;`
545
546			`va_start(ap, format);`
547
548			`if (ATA_DEVICE_DEBUG_LVL >= lvl)`
549			`{`
550			`fprintf(stderr, "ata_device_debug: ");`
551			`vfprintf(stderr, format, ap);`
552			`}`
553
554			`va_end(ap);`
555			`return 0;`
556			`}`