summaryrefslogtreecommitdiffstats
path: root/c/src/lib/libbsp/powerpc
diff options
context:
space:
mode:
authorSebastian Huber <sebastian.huber@embedded-brains.de>2018-04-23 12:53:28 +0200
committerSebastian Huber <sebastian.huber@embedded-brains.de>2018-04-23 15:18:46 +0200
commitfc79b268eb1d0588588c529888ce585f5cacf7c0 (patch)
tree1f219271db6d15f164fc5158851ad30d33490e91 /c/src/lib/libbsp/powerpc
parentbsps: Move PCI drivers to bsps (diff)
downloadrtems-fc79b268eb1d0588588c529888ce585f5cacf7c0.tar.bz2
bsps: Move ATA drivers to bsps
This patch is a part of the BSP source reorganization. Update #3285.
Diffstat (limited to 'c/src/lib/libbsp/powerpc')
-rw-r--r--c/src/lib/libbsp/powerpc/gen5200/Makefile.am8
-rw-r--r--c/src/lib/libbsp/powerpc/gen5200/ide/ata-dma-pio-single.c189
-rw-r--r--c/src/lib/libbsp/powerpc/gen5200/ide/ata-instance.c41
-rw-r--r--c/src/lib/libbsp/powerpc/gen5200/ide/idecfg.c100
-rw-r--r--c/src/lib/libbsp/powerpc/gen5200/ide/pcmcia_ide.c682
-rw-r--r--c/src/lib/libbsp/powerpc/gen5200/ide/pcmcia_ide.h98
6 files changed, 4 insertions, 1114 deletions
diff --git a/c/src/lib/libbsp/powerpc/gen5200/Makefile.am b/c/src/lib/libbsp/powerpc/gen5200/Makefile.am
index d4801ec541..46d5cd0cc1 100644
--- a/c/src/lib/libbsp/powerpc/gen5200/Makefile.am
+++ b/c/src/lib/libbsp/powerpc/gen5200/Makefile.am
@@ -62,11 +62,11 @@ librtemsbsp_a_SOURCES += ../../../../../../bsps/powerpc/gen5200/i2c/i2c.c
librtemsbsp_a_SOURCES += ../../../../../../bsps/powerpc/gen5200/i2c/i2cdrv.c
librtemsbsp_a_SOURCES += ../../../../../../bsps/powerpc/gen5200/i2c/mpc5200mbus.c
# ide
-librtemsbsp_a_SOURCES += ide/idecfg.c
-librtemsbsp_a_SOURCES += ide/pcmcia_ide.c
+librtemsbsp_a_SOURCES += ../../../../../../bsps/powerpc/gen5200/ata/idecfg.c
+librtemsbsp_a_SOURCES += ../../../../../../bsps/powerpc/gen5200/ata/pcmcia_ide.c
librtemsbsp_a_SOURCES += ../../../../../../bsps/powerpc/gen5200/dev/mpc5200-ata.c
-librtemsbsp_a_SOURCES += ide/ata-instance.c
-librtemsbsp_a_SOURCES += ide/ata-dma-pio-single.c
+librtemsbsp_a_SOURCES += ../../../../../../bsps/powerpc/gen5200/ata/ata-instance.c
+librtemsbsp_a_SOURCES += ../../../../../../bsps/powerpc/gen5200/ata/ata-dma-pio-single.c
# irq
librtemsbsp_a_SOURCES += ../../../../../../bsps/powerpc/gen5200/irq/irq.c
diff --git a/c/src/lib/libbsp/powerpc/gen5200/ide/ata-dma-pio-single.c b/c/src/lib/libbsp/powerpc/gen5200/ide/ata-dma-pio-single.c
deleted file mode 100644
index e621febbb0..0000000000
--- a/c/src/lib/libbsp/powerpc/gen5200/ide/ata-dma-pio-single.c
+++ /dev/null
@@ -1,189 +0,0 @@
-/*
- * Copyright (c) 2011-2013 embedded brains GmbH. All rights reserved.
- *
- * embedded brains GmbH
- * Dornierstr. 4
- * 82178 Puchheim
- * Germany
- * <rtems@embedded-brains.de>
- *
- * The license and distribution terms for this file may be
- * found in the file LICENSE in this distribution or at
- * http://www.rtems.org/license/LICENSE.
- */
-
-#define NDEBUG
-
-#include <bsp/ata.h>
-
-#include <libcpu/powerpc-utility.h>
-
-#include <bsp.h>
-#include <bsp/fatal.h>
-#include <bsp/irq.h>
-
-typedef enum {
- DATA_CURRENT = 0,
- DATA_END,
- DATA_REG
-} variables;
-
-typedef enum {
- INC_0_NE = 0,
- INC_2_NE
-} increments;
-
-/*
- * for
- * idx0 = DATA_CURRENT, idx1 = DATA_REG
- * idx0 != DATA_END
- * idx0 += 2, idx1 += 0
- * do
- * *idx0 = *idx1 [INT, 16 bit] OR *idx1 = *idx0 [INT, 16 bit]
- */
-static const uint32_t ops[] = {
- LCD(0, VAR(DATA_CURRENT), 0, VAR(DATA_REG), TERM_FIRST, VAR(DATA_END), INC_2_NE, INC_0_NE),
- 0, /* Transfer opcode, see transfer() */
-};
-
-static bool is_last_transfer(const ata_driver_dma_pio_single *self)
-{
- return self->transfer_current + 1 == self->transfer_end;
-}
-
-static void start_sector_transfer(ata_driver_dma_pio_single *self)
-{
- uint16_t *current = ata_sg_get_sector_data_begin(&self->sg_context, self->transfer_current);
- bestcomm_task_set_variable(&self->task, DATA_CURRENT, (uint32_t) current);
- bestcomm_task_set_variable(&self->task, DATA_END, (uint32_t) ata_sg_get_sector_data_end(&self->sg_context, current));
- bestcomm_task_start(&self->task);
-
- bool last = is_last_transfer(self);
- ++self->transfer_current;
-
- if (!last) {
- ata_flush_sector(ata_sg_get_sector_data_begin(&self->sg_context, self->transfer_current));
- }
-}
-
-static void dma_pio_single_interrupt_handler(void *arg)
-{
- ata_driver_dma_pio_single *self = arg;
- bool ok = ata_check_status();
- bool send_event = false;
- if (ok && self->transfer_current != self->transfer_end) {
- bool enable_dma_interrupt = self->read && is_last_transfer(self);
- if (enable_dma_interrupt) {
- bestcomm_task_irq_clear(&self->task);
- bestcomm_task_irq_enable(&self->task);
- }
-
- start_sector_transfer(self);
- } else {
- send_event = true;
- }
-
- if (send_event) {
- bestcomm_task_wakeup_event_task(&self->task);
- }
-}
-
-static bool transfer_dma_pio_single(ata_driver *super, bool read, rtems_blkdev_sg_buffer *sg, size_t sg_count)
-{
- bool ok = true;
- ata_driver_dma_pio_single *self = (ata_driver_dma_pio_single *) super;
-
- self->read = read;
- ata_sg_reset(&self->sg_context, sg, sg_count);
- rtems_blkdev_bnum start_sector = ata_sg_get_start_sector(&self->sg_context);
- rtems_blkdev_bnum sector_count = ata_sg_get_sector_count(&self->sg_context);
- rtems_blkdev_bnum relative_sector = 0;
-
- ata_flush_sector(ata_sg_get_sector_data_begin(&self->sg_context, relative_sector));
-
- uint8_t command = ata_read_or_write_sectors_command(read);
-
- uint32_t opcode;
- if (read) {
- opcode = DRD1A(INT, INIT_ALWAYS, DEST_DEREF_IDX(0), SZ_16, SRC_DEREF_IDX(1), SZ_16);
- } else {
- opcode = DRD1A(INT, INIT_ALWAYS, DEST_DEREF_IDX(1), SZ_16, SRC_DEREF_IDX(0), SZ_16);
- }
-
- bestcomm_task_irq_disable(&self->task);
- bestcomm_task_associate_with_current_task(&self->task);
-
- size_t transfer_opcode_index = 1; /* See ops */
- bestcomm_task_set_opcode(&self->task, transfer_opcode_index, opcode);
-
- while (ok && relative_sector < sector_count) {
- rtems_blkdev_bnum remaining_sectors = sector_count - relative_sector;
- rtems_blkdev_bnum transfer_count = ata_max_transfer_count(remaining_sectors);
-
- self->transfer_current = relative_sector;
- self->transfer_end = relative_sector + transfer_count;
-
- ok = ata_execute_io_command(command, start_sector + relative_sector, transfer_count);
- if (ok) {
- if (!read) {
- ok = ata_wait_for_data_request();
- assert(ok);
-
- rtems_interrupt_level level;
- rtems_interrupt_disable(level);
- start_sector_transfer(self);
- rtems_interrupt_enable(level);
- }
-
- bestcomm_task_wait(&self->task);
-
- ok = ata_check_status();
-
- relative_sector += ATA_PER_TRANSFER_SECTOR_COUNT_MAX;
- }
- }
-
- return ok;
-}
-
-static int io_control_dma_pio_single(
- rtems_disk_device *dd,
- uint32_t cmd,
- void *arg
-)
-{
- return ata_driver_io_control(dd, cmd, arg, transfer_dma_pio_single);
-}
-
-void ata_driver_dma_pio_single_create(ata_driver_dma_pio_single *self, const char *device_file_path, TaskId task_index)
-{
- ata_driver_create(&self->super, device_file_path, io_control_dma_pio_single);
-
- self->read = false;
-
- if (ata_driver_is_card_present(&self->super)) {
- bestcomm_task_create_and_load(&self->task, task_index, ops, sizeof(ops));
-
- bestcomm_task_set_variable(&self->task, DATA_REG, (uint32_t) &ATA->write.data);
-
- bestcomm_task_set_increment_and_condition(&self->task, INC_0_NE, 0, COND_NE);
- bestcomm_task_set_increment_and_condition(&self->task, INC_2_NE, 2, COND_NE);
-
- bestcomm_task_enable_combined_write(&self->task, true);
- bestcomm_task_enable_read_buffer(&self->task, true);
- bestcomm_task_enable_speculative_read(&self->task, true);
-
- ata_clear_interrupts();
-
- rtems_status_code sc = rtems_interrupt_handler_install(
- BSP_SIU_IRQ_ATA,
- "ATA",
- RTEMS_INTERRUPT_UNIQUE,
- dma_pio_single_interrupt_handler,
- self
- );
- if (sc != RTEMS_SUCCESSFUL) {
- bsp_fatal(MPC5200_FATAL_ATA_DMA_SINGLE_IRQ_INSTALL);
- }
- }
-}
diff --git a/c/src/lib/libbsp/powerpc/gen5200/ide/ata-instance.c b/c/src/lib/libbsp/powerpc/gen5200/ide/ata-instance.c
deleted file mode 100644
index b2b26341f6..0000000000
--- a/c/src/lib/libbsp/powerpc/gen5200/ide/ata-instance.c
+++ /dev/null
@@ -1,41 +0,0 @@
-/*
- * Copyright (c) 2011-2013 embedded brains GmbH. All rights reserved.
- *
- * embedded brains GmbH
- * Dornierstr. 4
- * 82178 Puchheim
- * Germany
- * <rtems@embedded-brains.de>
- *
- * The license and distribution terms for this file may be
- * found in the file LICENSE in this distribution or at
- * http://www.rtems.org/license/LICENSE.
- */
-
-#include <bsp/ata.h>
-#include <bsp/fatal.h>
-
-#include <libchip/ata.h>
-
-#include <bsp.h>
-
-static ata_driver_dma_pio_single ata_driver_instance;
-
-rtems_status_code rtems_ata_initialize(
- rtems_device_major_number major,
- rtems_device_minor_number minor_arg,
- void *arg
-)
-{
- rtems_status_code sc = rtems_disk_io_initialize();
-
- if (sc == RTEMS_SUCCESSFUL) {
- bestcomm_glue_init();
-
- ata_driver_dma_pio_single_create(&ata_driver_instance, "/dev/hda", TASK_PCI_TX);
- } else {
- bsp_fatal(MPC5200_FATAL_ATA_DISK_IO_INIT);
- }
-
- return sc;
-}
diff --git a/c/src/lib/libbsp/powerpc/gen5200/ide/idecfg.c b/c/src/lib/libbsp/powerpc/gen5200/ide/idecfg.c
deleted file mode 100644
index 8cd26beef3..0000000000
--- a/c/src/lib/libbsp/powerpc/gen5200/ide/idecfg.c
+++ /dev/null
@@ -1,100 +0,0 @@
-/*===============================================================*\
-| Project: RTEMS generic MPC5200 BSP |
-+-----------------------------------------------------------------+
-| Copyright (c) 2005 |
-| Embedded Brains GmbH |
-| Obere Lagerstr. 30 |
-| D-82178 Puchheim |
-| Germany |
-| rtems@embedded-brains.de |
-+-----------------------------------------------------------------+
-| The license and distribution terms for this file may be |
-| found in the file LICENSE in this distribution or at |
-| |
-| http://www.rtems.org/license/LICENSE. |
-| |
-+-----------------------------------------------------------------+
-| this file contains the IDE configuration |
-\*===============================================================*/
-#include <rtems.h>
-#include <bsp.h>
-#include <bsp/irq.h>
-#include <bsp/mpc5200.h>
-#include "./pcmcia_ide.h"
-
-#include <libchip/ide_ctrl.h>
-#include <libchip/ide_ctrl_cfg.h>
-#include <libchip/ide_ctrl_io.h>
-
-/*
- * The following table configures the IDE driver used in this BSP.
- */
-extern ide_ctrl_fns_t mpc5200_pcmciaide_ctrl_fns;
-
-volatile uint32_t * mpc5200_ata_drive_regs[] =
- {
- (uint32_t *)&(mpc5200.ata_ddr), /* data (offset 0x00) */
- (uint32_t *)&(mpc5200.ata_dfr_der), /* features / error (offset 0x01) */
- (uint32_t *)&(mpc5200.ata_dscr), /* sector count (offset 0x02) */
- (uint32_t *)&(mpc5200.ata_dsnr), /* sector no. / lba0 (offset 0x03) */
- (uint32_t *)&(mpc5200.ata_dclr), /* cylinder low / lba1 (offset 0x04) */
- (uint32_t *)&(mpc5200.ata_dchr), /* cylinder high/ lba2 (offset 0x05) */
- (uint32_t *)&(mpc5200.ata_ddhr), /* device head / lba3 (offset 0x06) */
- (uint32_t *)&(mpc5200.ata_dcr_dsr), /* command /status (offset 0x07) */
-
- (uint32_t *)&(mpc5200.ata_dctr_dasr), /* device control / alternate status (offset 0x08) */
- (uint32_t *)&(mpc5200.ata_ddr), /* (offset 0x09) */
- (uint32_t *)&(mpc5200.ata_ddr), /* (offset 0x0A) */
- NULL, /* (offset 0x0B) */
- NULL, /* (offset 0x0C) */
- NULL, /* (offset 0x0D) */
- NULL, /* (offset 0x0E) */
- NULL /* (offset 0x0F) */
- };
-
-/* IDE controllers Table */
-ide_controller_bsp_table_t IDE_Controller_Table[] =
- {
- {
- "/dev/idepcmcia",
- IDE_CUSTOM, /* PCMCIA Flash cards emulate custom IDE controller */
- &mpc5200_pcmciaide_ctrl_fns, /* pointer to function set used for IDE drivers in this BSP */
- NULL, /* no BSP dependent probe needed */
- FALSE, /* not (yet) initialized */
- (uint32_t)0, /* no port address but custom reg.set in params is used */
-#ifdef ATA_USE_INT
- TRUE, /* interrupt driven */
-#else
- FALSE, /* non interrupt driven */
-#endif
- BSP_SIU_IRQ_ATA, /* interrupt vector */
- NULL /* no additional parameters */
- }
-};
-
-/* Number of rows in IDE_Controller_Table */
-unsigned long IDE_Controller_Count = sizeof(IDE_Controller_Table)/sizeof(IDE_Controller_Table[0]);
-
-uint32_t ata_pio_timings[2][6] =
- {
- /* PIO3 timings in nanosconds */
- {
- 180, /* t0 cycle time */
- 80, /* t2 DIOR-/DIOW pulse width 8 bit */
- 80, /* t1 DIOR-/DIOW pulse width 16 bit */
- 10, /* t4 DIOW- data hold */
- 30, /* t1 Addr.valid to DIOR-/DIOW setup */
- 35, /* ta IORDY setup time */
- },
- /* PIO4 timings in nanosconds */
- {
- 120, /* t0 cycle time */
- 70, /* t1 DIOR-/DIOW pulse width 8 bit */
- 70, /* t1 DIOR-/DIOW pulse width 16 bit */
- 10, /* t4 DIOW- data hold */
- 25, /* t1 Addr.valid to DIOR-/DIOW setup */
- 35, /* ta IORDY setup time */
- }
- };
-
-
diff --git a/c/src/lib/libbsp/powerpc/gen5200/ide/pcmcia_ide.c b/c/src/lib/libbsp/powerpc/gen5200/ide/pcmcia_ide.c
deleted file mode 100644
index 9683ae383c..0000000000
--- a/c/src/lib/libbsp/powerpc/gen5200/ide/pcmcia_ide.c
+++ /dev/null
@@ -1,682 +0,0 @@
-/*===============================================================*\
-| Project: RTEMS generic MPC5200 BSP |
-+-----------------------------------------------------------------+
-| Partially based on the code references which are named below. |
-| Adaptions, modifications, enhancements and any recent parts of |
-| the code are: |
-| Copyright (c) 2005 |
-| Embedded Brains GmbH |
-| Obere Lagerstr. 30 |
-| D-82178 Puchheim |
-| Germany |
-| rtems@embedded-brains.de |
-+-----------------------------------------------------------------+
-| The license and distribution terms for this file may be |
-| found in the file LICENSE in this distribution or at |
-| |
-| http://www.rtems.org/license/LICENSE. |
-| |
-+-----------------------------------------------------------------+
-| this file contains the PCMCIA IDE access functions |
-\*===============================================================*/
-/***********************************************************************/
-/* */
-/* Module: pcmcia_ide.c */
-/* Date: 07/17/2003 */
-/* Purpose: RTEMS MPC5x00 PCMCIA IDE harddisk driver */
-/* */
-/*---------------------------------------------------------------------*/
-/* */
-/* Description: */
-/* */
-/*---------------------------------------------------------------------*/
-/* */
-/* Code */
-/* References: RTEMS MBX8xx PCMCIA IDE harddisc driver */
-/* Module: pcmcia_ide.c */
-/* Project: RTEMS 4.6.0pre1 / Mbx8xx BSP */
-/* Version */
-/* Date: 01/14/2003 */
-/* */
-/* Author(s) / Copyright(s): */
-/* */
-/* Copyright (c) 2003 IMD */
-/* Ingenieurbuero fuer Microcomputertechnik Th. Doerfler */
-/* <Thomas.Doerfler@imd-systems.de> */
-/* all rights reserved */
-/* */
-/* this file contains the BSP layer for PCMCIA IDE access below the */
-/* libchip IDE harddisc driver based on a board specific driver from */
-/* Eugeny S. Mints, Oktet */
-/* */
-/* The license and distribution terms for this file may be */
-/* found in the file LICENSE in this distribution or at */
-/* http://www.rtems.org/license/LICENSE. */
-/* */
-/*---------------------------------------------------------------------*/
-/* */
-/* Partially based on the code references which are named above. */
-/* Adaptions, modifications, enhancements and any recent parts of */
-/* the code are under the right of */
-/* */
-/* IPR Engineering, Dachauer Straße 38, D-80335 München */
-/* Copyright(C) 2003 */
-/* */
-/*---------------------------------------------------------------------*/
-/* */
-/* IPR Engineering makes no representation or warranties with */
-/* respect to the performance of this computer program, and */
-/* specifically disclaims any responsibility for any damages, */
-/* special or consequential, connected with the use of this program. */
-/* */
-/*---------------------------------------------------------------------*/
-/* */
-/* Version history: 1.0 */
-/* */
-/***********************************************************************/
-
-#include <sys/param.h>
-#include <rtems.h>
-#include <rtems/error.h>
-#include <rtems/score/sysstate.h>
-#include <bsp.h>
-#include <bsp/irq.h>
-#include <bsp/mpc5200.h>
-#include "./pcmcia_ide.h"
-
-#include <libchip/ide_ctrl.h>
-#include <libchip/ide_ctrl_cfg.h>
-#include <libchip/ide_ctrl_io.h>
-#include <string.h>
-
-#define IDE_DMA_TEST FALSE
-
-/* DMA supported PIO mode is broken */
-#define IDE_USE_INT TRUE
-#define IDE_READ_USE_DMA FALSE
-#define IDE_USE_READ_PIO_OPT FALSE
-#define IDE_WRITE_USE_DMA FALSE
-#define IDE_USE_WRITE_PIO_OPT FALSE
-#define IDE_USE_DMA (IDE_READ_USE_DMA || IDE_WRITE_USE_DMA)
-
-#define IDE_USE_STATISTICS TRUE
-
-#if IDE_USE_DMA
-#define PCMCIA_IDE_DMA_WR_BD_CNT 2
-#define PCMCIA_IDE_DMA_RD_BD_CNT 2
-#define PCMCIA_IDE_INTERRUPT_EVENT RTEMS_EVENT_2
-/* Task number assignment */
-#include "../bestcomm/bestcomm_glue.h"
-#include "../bestcomm/bestcomm_api.h"
-#include "../bestcomm/task_api/bestcomm_cntrl.h"
-#include "../bestcomm/task_api/tasksetup_bdtable.h"
-
-#define IDE_RX_TASK_NO TASK_GEN_DP_BD_0
-#define IDE_TX_TASK_NO TASK_GEN_DP_BD_1
-static TaskId pcmcia_ide_rxTaskId; /* SDMA RX task ID */
-static TaskId pcmcia_ide_txTaskId; /* SDMA TX task ID */
-#define PCMCIA_IDE_RD_SECTOR_SIZE 512 /* FIXME: make this better... */
-#define PCMCIA_IDE_WR_SECTOR_SIZE 512 /* FIXME: make this better... */
-
-bool mpc5200_dma_task_started[2] = {false,false};
-#endif /* IDE_USE_DMA */
-
-#if IDE_USE_STATISTICS
-uint32_t mpc5200_pcmciaide_write_block_call_cnt = 0;
-uint32_t mpc5200_pcmciaide_write_block_block_cnt = 0;
-uint32_t mpc5200_pcmciaide_read_block_call_cnt = 0;
-uint32_t mpc5200_pcmciaide_read_block_block_cnt = 0;
-#endif
-
-extern volatile uint32_t * mpc5200_ata_drive_regs[];
-extern uint32_t ata_pio_timings[2][6];
-
-void mpc5200_pcmciaide_dma_blockop(
- bool, int, uint16_t, rtems_blkdev_sg_buffer *, uint32_t *, uint32_t *);
-/*
- * support functions for PCMCIA IDE IF
- */
-static bool mpc5200_pcmciaide_probe(int minor)
- {
- bool ide_card_plugged = false; /* assume: we don't have a card plugged in */
- struct mpc5200_gpt *gpt = (struct mpc5200_gpt *)(&mpc5200.gpt[GPT2]);
-
- #ifdef MPC5200_BOARD_DP2
- /* Deactivate RESET signal */
- rtems_interrupt_level level;
- rtems_interrupt_disable(level);
- mpc5200.gpiowe |= GPIO_W_PIN_PSC1_4;
- mpc5200.gpiowod &= ~GPIO_W_PIN_PSC1_4;
- mpc5200.gpiowdd |= GPIO_W_PIN_PSC1_4;
- mpc5200.gpiowdo |= GPIO_W_PIN_PSC1_4;
- rtems_interrupt_enable(level);
- /* FIXME */
- volatile int i = 0;
- while (++i < 20000000);
- #endif
-
- /* enable card detection on GPT2 */
- gpt->emsel = (GPT_EMSEL_GPIO_IN | GPT_EMSEL_TIMER_MS_GPIO);
-
-#if defined (MPC5200_BOARD_BRS5L)
- /* Check for card detection (-CD0) */
- if((gpt->status) & GPT_STATUS_PIN)
- ide_card_plugged = false;
- else
-#endif
- ide_card_plugged = true;
-
- return ide_card_plugged;
-
- }
-
-#define DMA1_T0(val) BSP_BFLD32(COUNT_VAL(val), 0, 7)
-#define DMA1_TD(val) BSP_BFLD32(COUNT_VAL(val), 8, 15)
-#define DMA1_TK(val) BSP_BFLD32(COUNT_VAL(val), 16, 23)
-#define DMA1_TM(val) BSP_BFLD32(COUNT_VAL(val), 24, 31)
-
-#define DMA2_TH(val) BSP_BFLD32(COUNT_VAL(val), 0, 7)
-#define DMA2_TJ(val) BSP_BFLD32(COUNT_VAL(val), 8, 15)
-#define DMA2_TN(val) BSP_BFLD32(COUNT_VAL(val), 16, 23)
-
-static rtems_status_code mpc5200_pcmciaide_config_io_speed(int minor, uint16_t modes_avail)
- {
- uint8_t pio_t0, pio_t2_8, pio_t2_16, pio_t4, pio_t1, pio_ta;
-
- if((modes_avail & ATA_MODES_PIO4) != 0)
- {
-
- pio_t0 = ata_pio_timings[PIO_4][T0];
- pio_t2_8 = ata_pio_timings[PIO_4][T2_8];
- pio_t2_16 = ata_pio_timings[PIO_4][T2_16];
- pio_t4 = ata_pio_timings[PIO_4][T4];
- pio_t1 = ata_pio_timings[PIO_4][T1];
- pio_ta = ata_pio_timings[PIO_4][TA];
-
- }
- else
- {
-
- pio_t0 = ata_pio_timings[PIO_3][T0];
- pio_t2_8 = ata_pio_timings[PIO_3][T2_8];
- pio_t2_16 = ata_pio_timings[PIO_3][T2_16];
- pio_t4 = ata_pio_timings[PIO_3][T4];
- pio_t1 = ata_pio_timings[PIO_3][T1];
- pio_ta = ata_pio_timings[PIO_3][TA];
-
- }
-
- /* set timings according according to selected ATA mode */
- mpc5200.ata_pio1 = ATA_PIO_TIMING_1(pio_t0, pio_t2_8, pio_t2_16);
- mpc5200.ata_pio2 = ATA_PIO_TIMING_2(pio_t4, pio_t1, pio_ta);
-
- mpc5200.ata_dma1 = DMA1_T0(120) | DMA1_TD(70) | DMA1_TK(25) | DMA1_TM(25);
- mpc5200.ata_dma2 = DMA2_TH(10) | DMA2_TJ(5) | DMA2_TN(10);
-
- return RTEMS_SUCCESSFUL;
-
- }
-
-
-
-static void mpc5200_pcmciaide_read_reg(int minor, int reg, uint16_t *value)
- {
- volatile uint32_t *ata_reg = mpc5200_ata_drive_regs[reg];
-
- if(reg == IDE_REGISTER_DATA_WORD)
- *value = *(volatile uint16_t *)(ata_reg);
- else
- *value = *(volatile uint8_t *)(ata_reg);
- }
-
-
-static void mpc5200_pcmciaide_write_reg(int minor, int reg, uint16_t value)
- {
- volatile uint32_t *ata_reg = mpc5200_ata_drive_regs[reg];
-
- if(reg == IDE_REGISTER_DATA_WORD)
- *(volatile uint16_t *)(ata_reg) = value;
- else
- *(volatile uint8_t *)(ata_reg) = value;
- }
-
-#if IDE_USE_DMA
-
-
-uint32_t pcmcia_ide_rxInterrupts;
-uint32_t pcmcia_ide_txInterrupts;
-volatile rtems_id pcmcia_ide_hdl_task = 0;
-/*
- * MPC5200 BestComm interrupt handlers
- */
-static void pcmcia_ide_recv_dmairq_hdl(rtems_irq_hdl_param unused)
-{
- SDMA_CLEAR_IEVENT(&mpc5200.sdma.IntPend,IDE_RX_TASK_NO);
-
-/*Disable receive ints*/
- bestcomm_glue_irq_disable(IDE_RX_TASK_NO);
-
- pcmcia_ide_rxInterrupts++; /* Rx int has occurred */
-
- if (pcmcia_ide_hdl_task != 0) {
- rtems_event_send(pcmcia_ide_hdl_task,PCMCIA_IDE_INTERRUPT_EVENT);
- }
-}
-
-static void pcmcia_ide_xmit_dmairq_hdl(rtems_irq_hdl_param unused)
-{
-
- SDMA_CLEAR_IEVENT(&mpc5200.sdma.IntPend,IDE_TX_TASK_NO);
-
- /*Disable transmit ints*/
- bestcomm_glue_irq_disable(IDE_TX_TASK_NO);
-
- pcmcia_ide_txInterrupts++; /* Tx int has occurred */
-
- if (pcmcia_ide_hdl_task != 0) {
- rtems_event_send(pcmcia_ide_hdl_task,PCMCIA_IDE_INTERRUPT_EVENT);
- }
-}
-
-
-void mpc5200_pcmciaide_dma_init(int minor)
-{
- TaskSetupParamSet_t rxParam; /* RX task setup parameters */
- TaskSetupParamSet_t txParam; /* TX task setup parameters */
- /*
- * Init Bestcomm system
- */
- bestcomm_glue_init();
- /*
- * Setup the SDMA RX task.
- */
- rxParam.NumBD = PCMCIA_IDE_DMA_RD_BD_CNT;
- rxParam.Size.MaxBuf = PCMCIA_IDE_RD_SECTOR_SIZE;
- rxParam.Initiator = INITIATOR_ALWAYS;
- rxParam.StartAddrSrc =
- (uint32)mpc5200_ata_drive_regs[IDE_REGISTER_DATA_WORD];
- rxParam.IncrSrc = 0;
- rxParam.SzSrc = sizeof(uint16_t);
- rxParam.StartAddrDst = (uint32)NULL;
- rxParam.IncrDst = sizeof(uint16_t);
- rxParam.SzDst = sizeof(uint16_t); /* XXX: set this to 32 bit? */
-
- pcmcia_ide_rxTaskId = TaskSetup(IDE_RX_TASK_NO,&rxParam );
-
- /*
- * Setup the TX task.
- */
- txParam.NumBD = PCMCIA_IDE_DMA_WR_BD_CNT;
- txParam.Size.MaxBuf = PCMCIA_IDE_WR_SECTOR_SIZE;
- txParam.Initiator = INITIATOR_ALWAYS;
- txParam.StartAddrSrc = (uint32)NULL;
- txParam.IncrSrc = sizeof(uint16_t);
- txParam.SzSrc = sizeof(uint16_t); /* do not set this to 32 bit! */
- txParam.StartAddrDst =
- (uint32)mpc5200_ata_drive_regs[IDE_REGISTER_DATA_WORD];
- txParam.IncrDst = 0;
- txParam.SzDst = sizeof(uint16_t);
-
- pcmcia_ide_txTaskId = TaskSetup( IDE_TX_TASK_NO, &txParam );
- /*
- * FIXME: Init BD rings
- */
- /*
- * Enable the SmartDMA transmit/receive task.
- * do not enable interrupts to CPU
- */
- /*
- * connect interrupt handlers
- */
- bestcomm_glue_irq_install(IDE_TX_TASK_NO,pcmcia_ide_xmit_dmairq_hdl,NULL);
- bestcomm_glue_irq_install(IDE_RX_TASK_NO,pcmcia_ide_recv_dmairq_hdl,NULL);
-}
-#endif /* IDE_USE_DMA */
-
-void mpc5200_pcmciaide_dma_blockop(bool is_write,
- int minor,
- uint16_t block_size,
- rtems_blkdev_sg_buffer *bufs,
- uint32_t *cbuf,
- uint32_t *pos)
-
-{
-#if IDE_USE_DMA
- /*
- * Nameing:
- * - a block is one unit of data on disk (multiple sectors)
- * - a buffer is a contignuous chunk of data in memory
- * a block on disk may be filled with data from several buffers
- */
- uint32_t buf_idx,bufs_from_dma, bufs_to_dma,bufs_total;
- uint32_t bds_free;
- uint32_t llength;
- rtems_status_code rc = RTEMS_SUCCESSFUL;
- rtems_event_set events;
- BDIdx nxt_bd_idx;
- bool use_irq = (_System_state_Current == SYSTEM_STATE_UP);
- /*
- * determine number of blocks
- */
- llength = 0;
- buf_idx = 0;
- bufs += *cbuf; /* *cbuf is the index of the next buffer to send in this transaction */
- while (llength < block_size) {
- llength += bufs[buf_idx++].length;
- }
- bufs_from_dma = 0;
- bufs_to_dma = 0;
- bufs_total = buf_idx;
- /*
- * here all BDs should be unused
- */
- bds_free = is_write ? PCMCIA_IDE_DMA_WR_BD_CNT : PCMCIA_IDE_DMA_RD_BD_CNT;
- /*
- * repeat, until all bufs are transferred
- */
- while ((rc == RTEMS_SUCCESSFUL) &&
- (bufs_from_dma < bufs_total)) {
-
- while ((rc == RTEMS_SUCCESSFUL) &&
- (bufs_to_dma < bufs_total) &&
- (bds_free > 0)) {
- /*
- * fill in BD, set interrupt if needed
- */
- SDMA_CLEAR_IEVENT(&mpc5200.sdma.IntPend,(is_write
- ? IDE_TX_TASK_NO
- : IDE_RX_TASK_NO));
- if (is_write) {
- TaskBDAssign(pcmcia_ide_txTaskId ,
- (void *)bufs[bufs_to_dma].buffer,
- (void *)mpc5200_ata_drive_regs[IDE_REGISTER_DATA_WORD],
- bufs[bufs_to_dma].length,
- 0/* flags */);
-#if IDE_USE_STATISTICS
- mpc5200_pcmciaide_write_block_block_cnt++;
-#endif
- }
- else {
- TaskBDAssign(pcmcia_ide_rxTaskId ,
- (void *)mpc5200_ata_drive_regs[IDE_REGISTER_DATA_WORD],
- (void *)bufs[bufs_to_dma].buffer,
- bufs[bufs_to_dma].length,
- 0/* flags */);
-#if IDE_USE_STATISTICS
- mpc5200_pcmciaide_read_block_block_cnt++;
-#endif
- }
- bufs_to_dma ++;
- bds_free --;
- }
- if (is_write) {
- TaskStart( pcmcia_ide_txTaskId, TASK_AUTOSTART_DISABLE,
- pcmcia_ide_txTaskId, TASK_INTERRUPT_DISABLE );
- }
- else {
- TaskStart( pcmcia_ide_rxTaskId, TASK_AUTOSTART_DISABLE,
- pcmcia_ide_rxTaskId, TASK_INTERRUPT_DISABLE );
- }
- if (use_irq) {
-
- /*
- * enable interrupts, wait for interrupt event
- */
- pcmcia_ide_hdl_task = rtems_task_self();
- bestcomm_glue_irq_enable((is_write
- ? IDE_TX_TASK_NO
- : IDE_RX_TASK_NO));
-
- rtems_event_receive(PCMCIA_IDE_INTERRUPT_EVENT,
- RTEMS_WAIT | RTEMS_EVENT_ANY,
- RTEMS_NO_TIMEOUT, &events);
-
- pcmcia_ide_hdl_task = 0;
- }
- else {
- /*
- * HACK: just wait some time...
- */
- /*
- * FIXME: poll, until SDMA is finished
- */
- volatile int32_t i;
- for (i = 0;i < 10000;i++) {};
- }
-
- do {
- nxt_bd_idx = TaskBDRelease(is_write
- ? pcmcia_ide_txTaskId
- : pcmcia_ide_rxTaskId);
- if ((nxt_bd_idx != TASK_ERR_BD_RING_EMPTY) &&
- (nxt_bd_idx != TASK_ERR_BD_BUSY)) {
- (*cbuf)++;
- (*pos) += bufs[bufs_from_dma].length;
- bufs_from_dma++;
- bds_free++;
- }
- } while ((nxt_bd_idx != TASK_ERR_BD_RING_EMPTY) &&
- (nxt_bd_idx != TASK_ERR_BD_BUSY) &&
- (bufs_from_dma < bufs_to_dma));
- }
-#endif /* IDE_USE_DMA */
-}
-
-
-static void mpc5200_pcmciaide_read_block(int minor, uint32_t block_size,
- rtems_blkdev_sg_buffer *bufs, uint32_t *cbuf, uint32_t *pos)
-{
-
- volatile uint32_t *ata_reg=mpc5200_ata_drive_regs[IDE_REGISTER_DATA_WORD];
- uint16_t cnt = 0;
- uint16_t *lbuf = (uint16_t*)((uint8_t*)(bufs[(*cbuf)].buffer)+(*pos));
- uint32_t llength = bufs[(*cbuf)].length;
- bool use_dma;
-
-#if IDE_USE_STATISTICS
- mpc5200_pcmciaide_read_block_call_cnt++;
-#endif
-#if IDE_READ_USE_DMA
- /*
- * FIXME: walk through buffer list. If any buffer has other size than default,
- * then do not use DMA
- * Is this needed?
- */
- use_dma = true;
- /* use_dma = false; */
-#else
- use_dma = false;
-#endif
- if (use_dma) {
- /*
- * FIXME: wait for DRQ ready
- * check, that once DRQ is ready, we really can send ALL data for this
- * type of transfer mode
- */
- while ((GET_UP_BYTE_OF_MPC5200_ATA_DRIVE_REG((volatile uint32_t)
- (mpc5200.ata_dctr_dasr)) &
- IDE_REGISTER_STATUS_DRQ) == 0);
- /*
- * translate (part of) buffer list into DMA BDs
- * only last (available) DMA BD sends interrupt
- * DMA BDs may get ready as soon as possible
- */
- mpc5200_pcmciaide_dma_blockop(FALSE, /* read operation */
- minor,
- block_size,bufs,cbuf,pos);
- }
- else {
-#if IDE_USE_READ_PIO_OPT
- while(cnt < block_size) {
-
- *lbuf++ = GET_UP_WORD_OF_MPC5200_ATA_DRIVE_REG(*(volatile uint32_t *)(ata_reg)); /* only 16 bit data port */
- cnt += 2;
- (*pos) += 2;
-
- if((*pos) == llength) {
-
- (*pos) = 0;
- (*cbuf)++;
- lbuf = bufs[(*cbuf)].buffer;
- llength = bufs[(*cbuf)].length;
-
- }
- }
-#else
-
- while((GET_UP_BYTE_OF_MPC5200_ATA_DRIVE_REG((volatile uint32_t)(mpc5200.ata_dctr_dasr)) & IDE_REGISTER_STATUS_DRQ) && (cnt < block_size)) {
-
- *lbuf++ = *(volatile uint16_t *)(ata_reg); /* only 16 bit data port */
- cnt += 2;
- (*pos) += 2;
-
- if((*pos) == llength) {
- (*pos) = 0;
- (*cbuf)++;
- lbuf = bufs[(*cbuf)].buffer;
- llength = bufs[(*cbuf)].length;
- }
- }
-#endif
- }
-}
-
-static void mpc5200_pcmciaide_write_block(int minor, uint32_t block_size,
- rtems_blkdev_sg_buffer *bufs, uint32_t *cbuf, uint32_t *pos)
-{
-
-
- volatile uint32_t *ata_reg = mpc5200_ata_drive_regs[IDE_REGISTER_DATA_WORD];
- uint16_t cnt = 0;
- uint16_t *lbuf = (uint16_t *)((uint8_t *)(bufs[(*cbuf)].buffer) + (*pos));
- uint32_t llength = bufs[(*cbuf)].length;
- bool use_dma;
-
-#if IDE_USE_STATISTICS
- mpc5200_pcmciaide_write_block_call_cnt++;
-#endif
-#if IDE_WRITE_USE_DMA
- /*
- * FIXME: walk through buffer list. If any buffer has other size than default,
- * then do not use DMA
- * Is this needed?
- */
- use_dma = true;
-#else
- use_dma = false;
-#endif
-
- if (use_dma) {
- /*
- * wait for DRQ ready
- * FIXME: check, that once DRQ is ready, we really can send ALL data for this
- * type of transfer mode
- */
- while ((GET_UP_BYTE_OF_MPC5200_ATA_DRIVE_REG((volatile uint32_t)
- (mpc5200.ata_dctr_dasr)) &
- IDE_REGISTER_STATUS_DRQ) == 0);
- /*
- * translate (part of) buffer list into DMA BDs
- * only last (available) DMA BD sends interrupt
- * DMA BDs may get ready as soon as possible
- */
- mpc5200_pcmciaide_dma_blockop(true, /* write opeartion */
- minor,
- block_size,bufs,cbuf,pos);
- }
- else {
-#if IDE_USE_WRITE_PIO_OPT
- while(cnt < block_size) {
- int32_t loop_cnt,loop_max;
-
-#if IDE_USE_STATISTICS
- mpc5200_pcmciaide_write_block_block_cnt++;
-#endif
-
- loop_max = llength - (*pos) ;
- if (loop_max > (block_size - cnt)) {
- loop_max = (block_size - cnt);
- }
- for (loop_cnt = loop_max/2;loop_cnt > 0;loop_cnt--) {
- *(volatile uint32_t *)(ata_reg) =
- SET_UP_WORD_OF_MPC5200_ATA_DRIVE_REG(*lbuf++); /* only 16 bit data port */
- }
- cnt += loop_max;
- (*pos) += loop_max;
-
- if((*pos) == llength) {
-
- (*pos) = 0;
- (*cbuf)++;
- lbuf = bufs[(*cbuf)].buffer;
- llength = bufs[(*cbuf)].length;
- }
- }
-#else
- while((GET_UP_BYTE_OF_MPC5200_ATA_DRIVE_REG((volatile uint32_t)(mpc5200.ata_dctr_dasr))
- & IDE_REGISTER_STATUS_DRQ)
- && (cnt < block_size)) {
- *(volatile uint16_t *)(ata_reg) = *lbuf++; /* only 16 bit data port */
- cnt += 2;
- (*pos) += 2;
-
- if((*pos) == llength) {
- (*pos) = 0;
- (*cbuf)++;
- lbuf = bufs[(*cbuf)].buffer;
- llength = bufs[(*cbuf)].length;
- }
- }
-#endif
- }
-}
-
-static int mpc5200_pcmciaide_control(int minor, uint32_t cmd, void * arg)
- {
- return RTEMS_SUCCESSFUL;
- }
-
-static void mpc5200_pcmciaide_initialize(int minor)
- {
-#if defined (MPC5200_BOARD_BRS5L)
- struct mpc5200_gpt *gpt = (struct mpc5200_gpt *)(&mpc5200.gpt[GPT7]);
-
- /* invert ATA reset on GPT7 */
- gpt->emsel = (GPT_EMSEL_GPIO_OUT_HIGH | GPT_EMSEL_TIMER_MS_GPIO);
-#endif
- /* reset ata host contr. and FIFO */
- mpc5200.ata_hcfg |= (ATA_HCFG_SMR | ATA_HCFG_FR);
- mpc5200.ata_hcfg &= ~(ATA_HCFG_SMR | ATA_HCFG_FR);
-
- /* for the first access set lowest performance transfer mode to PIO3 */
- mpc5200_pcmciaide_config_io_speed(minor, ATA_MODES_PIO3);
-
- /* enable PIO operations (PIO 3/4) */
- mpc5200.ata_hcfg |= ATA_HCFG_IORDY;
-
-#ifdef IDE_USE_INT
- mpc5200.ata_hcfg |= ATA_HCFG_IE ;
-#endif
-
-#if IDE_USE_DMA
- mpc5200_pcmciaide_dma_init(minor);
-#endif
- }
-
-
-/*
- * The following table configures the functions used for IDE drivers
- * in this BSP.
- */
-ide_ctrl_fns_t mpc5200_pcmciaide_ctrl_fns =
- {
- mpc5200_pcmciaide_probe,
- mpc5200_pcmciaide_initialize,
- mpc5200_pcmciaide_control,
- mpc5200_pcmciaide_read_reg,
- mpc5200_pcmciaide_write_reg,
- mpc5200_pcmciaide_read_block,
- mpc5200_pcmciaide_write_block,
- mpc5200_pcmciaide_config_io_speed
- };
-
diff --git a/c/src/lib/libbsp/powerpc/gen5200/ide/pcmcia_ide.h b/c/src/lib/libbsp/powerpc/gen5200/ide/pcmcia_ide.h
deleted file mode 100644
index 8cd74729a5..0000000000
--- a/c/src/lib/libbsp/powerpc/gen5200/ide/pcmcia_ide.h
+++ /dev/null
@@ -1,98 +0,0 @@
-/*===============================================================*\
-| Project: RTEMS generic MPC5200 BSP |
-+-----------------------------------------------------------------+
-| Partially based on the code references which are named below. |
-| Adaptions, modifications, enhancements and any recent parts of |
-| the code are: |
-| Copyright (c) 2005 |
-| Embedded Brains GmbH |
-| Obere Lagerstr. 30 |
-| D-82178 Puchheim |
-| Germany |
-| rtems@embedded-brains.de |
-+-----------------------------------------------------------------+
-| The license and distribution terms for this file may be |
-| found in the file LICENSE in this distribution or at |
-| |
-| http://www.rtems.org/license/LICENSE. |
-| |
-+-----------------------------------------------------------------+
-| this file contains declarations for the PCMCIA IDE Interface |
-\*===============================================================*/
-/***********************************************************************/
-/* */
-/* Module: pcmcia_ide.h */
-/* Date: 17/07/2003 */
-/* Purpose: RTEMS MPC5x00 PCMCIA IDE harddisk header file */
-/* */
-/*---------------------------------------------------------------------*/
-/* */
-/* Description: */
-/* */
-/*---------------------------------------------------------------------*/
-/* */
-/* Code */
-/* References: none */
-/* Module: */
-/* Project: */
-/* Version */
-/* Date: */
-/* */
-/* Author(s) / Copyright(s): */
-/* */
-/*---------------------------------------------------------------------*/
-/* */
-/* Partially based on the code references which are named above. */
-/* Adaptions, modifications, enhancements and any recent parts of */
-/* the code are under the right of */
-/* */
-/* IPR Engineering, Dachauer Straße 38, D-80335 München */
-/* Copyright(C) 2003 */
-/* */
-/*---------------------------------------------------------------------*/
-/* */
-/* IPR Engineering makes no representation or warranties with */
-/* respect to the performance of this computer program, and */
-/* specifically disclaims any responsibility for any damages, */
-/* special or consequential, connected with the use of this program. */
-/* */
-/*---------------------------------------------------------------------*/
-/* */
-/* Version history: 1.0 */
-/* */
-/***********************************************************************/
-
-#ifndef __PCMCIA_IDE_h
-#define __PCMCIA_IDE_h
-
-#include <bsp.h>
-
-#define GPIOPCR_ATA_CS_4_5 (1 << 24)
-
-/*#define DEBUG_OUT*/
-#define GET_UP_BYTE_OF_MPC5200_ATA_DRIVE_REG(val32) ((uint16_t)((val32) >> 24))
-#define SET_UP_BYTE_OF_MPC5200_ATA_DRIVE_REG(val8) ((uint32_t)((val8) << 24))
-#define GET_UP_WORD_OF_MPC5200_ATA_DRIVE_REG(val32) ((uint16_t)((val32) >> 16))
-#define SET_UP_WORD_OF_MPC5200_ATA_DRIVE_REG(val16) ((uint32_t)((val16) << 16))
-
-#define ATA_HCFG_SMR (1 << 31)
-#define ATA_HCFG_FR (1 << 30)
-#define ATA_HCFG_IORDY (1 << 24)
-#define ATA_HCFG_IE (1 << 25)
-
-#define COUNT_VAL(nsec) (((nsec) * (IPB_CLOCK / 1000000) + 999) / 1000)
-
-#define PIO_3 0
-#define PIO_4 1
-
-#define T0 0
-#define T2_8 1
-#define T2_16 2
-#define T4 3
-#define T1 4
-#define TA 5
-
-#define ATA_PIO_TIMING_1(t0,t2_8,t2_16) (((COUNT_VAL(t0)) << 24) | ((COUNT_VAL(t2_8)) << 16) | ((COUNT_VAL(t2_16)) << 8))
-#define ATA_PIO_TIMING_2(t4,t1,ta) (((COUNT_VAL(t4)) << 24) | ((COUNT_VAL(t1)) << 16) | ((COUNT_VAL(ta)) << 8))
-
-#endif