Move input_data() and friends to board/cpc45/ide.c, as overrides for weak aliases in cmd_ide.c note: checkpatch emits warnings about using volatile Signed-off-by: Pavel Herrmann <morpheus.ibis@gmail.com>master
parent
f5b82c0f9c
commit
28920b1fd2
@ -0,0 +1,130 @@ |
|||||||
|
/*
|
||||||
|
* (C) Copyright 2001 |
||||||
|
* Rob Taylor, Flying Pig Systems. robt@flyingpig.com. |
||||||
|
* |
||||||
|
* (C) Copyright 2000-2011 |
||||||
|
* Wolfgang Denk, DENX Software Engineering, wd@denx.de. |
||||||
|
* |
||||||
|
* See file CREDITS for list of people who contributed to this |
||||||
|
* project. |
||||||
|
* |
||||||
|
* 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., 59 Temple Place, Suite 330, Boston, |
||||||
|
* MA 02111-1307 USA |
||||||
|
*/ |
||||||
|
|
||||||
|
#include <common.h> |
||||||
|
#include <ide.h> |
||||||
|
#include <ata.h> |
||||||
|
|
||||||
|
#define EIEIO __asm__ volatile ("eieio") |
||||||
|
#define SYNC __asm__ volatile ("sync") |
||||||
|
|
||||||
|
void ide_input_swap_data(int dev, ulong *sect_buf, int words) |
||||||
|
{ |
||||||
|
uchar i; |
||||||
|
volatile uchar *pbuf_even = |
||||||
|
(uchar *) (ATA_CURR_BASE(dev) + ATA_DATA_EVEN); |
||||||
|
volatile uchar *pbuf_odd = |
||||||
|
(uchar *) (ATA_CURR_BASE(dev) + ATA_DATA_ODD); |
||||||
|
ushort *dbuf = (ushort *) sect_buf; |
||||||
|
|
||||||
|
while (words--) { |
||||||
|
for (i = 0; i < 2; i++) { |
||||||
|
*(((uchar *) (dbuf)) + 1) = *pbuf_even; |
||||||
|
*(uchar *) dbuf = *pbuf_odd; |
||||||
|
dbuf += 1; |
||||||
|
} |
||||||
|
} |
||||||
|
} |
||||||
|
|
||||||
|
void ide_input_data(int dev, ulong *sect_buf, int words) |
||||||
|
{ |
||||||
|
uchar *dbuf; |
||||||
|
volatile uchar *pbuf_even; |
||||||
|
volatile uchar *pbuf_odd; |
||||||
|
|
||||||
|
pbuf_even = (uchar *) (ATA_CURR_BASE(dev) + ATA_DATA_EVEN); |
||||||
|
pbuf_odd = (uchar *) (ATA_CURR_BASE(dev) + ATA_DATA_ODD); |
||||||
|
dbuf = (uchar *) sect_buf; |
||||||
|
while (words--) { |
||||||
|
*dbuf++ = *pbuf_even; |
||||||
|
EIEIO; |
||||||
|
SYNC; |
||||||
|
*dbuf++ = *pbuf_odd; |
||||||
|
EIEIO; |
||||||
|
SYNC; |
||||||
|
*dbuf++ = *pbuf_even; |
||||||
|
EIEIO; |
||||||
|
SYNC; |
||||||
|
*dbuf++ = *pbuf_odd; |
||||||
|
EIEIO; |
||||||
|
SYNC; |
||||||
|
} |
||||||
|
} |
||||||
|
|
||||||
|
void ide_input_data_shorts(int dev, ushort *sect_buf, int shorts) |
||||||
|
{ |
||||||
|
uchar *dbuf; |
||||||
|
volatile uchar *pbuf_even; |
||||||
|
volatile uchar *pbuf_odd; |
||||||
|
|
||||||
|
pbuf_even = (uchar *) (ATA_CURR_BASE(dev) + ATA_DATA_EVEN); |
||||||
|
pbuf_odd = (uchar *) (ATA_CURR_BASE(dev) + ATA_DATA_ODD); |
||||||
|
dbuf = (uchar *) sect_buf; |
||||||
|
while (shorts--) { |
||||||
|
EIEIO; |
||||||
|
*dbuf++ = *pbuf_even; |
||||||
|
EIEIO; |
||||||
|
*dbuf++ = *pbuf_odd; |
||||||
|
} |
||||||
|
} |
||||||
|
|
||||||
|
void ide_output_data(int dev, const ulong *sect_buf, int words) |
||||||
|
{ |
||||||
|
uchar *dbuf; |
||||||
|
volatile uchar *pbuf_even; |
||||||
|
volatile uchar *pbuf_odd; |
||||||
|
|
||||||
|
pbuf_even = (uchar *) (ATA_CURR_BASE(dev) + ATA_DATA_EVEN); |
||||||
|
pbuf_odd = (uchar *) (ATA_CURR_BASE(dev) + ATA_DATA_ODD); |
||||||
|
dbuf = (uchar *) sect_buf; |
||||||
|
while (words--) { |
||||||
|
EIEIO; |
||||||
|
*pbuf_even = *dbuf++; |
||||||
|
EIEIO; |
||||||
|
*pbuf_odd = *dbuf++; |
||||||
|
EIEIO; |
||||||
|
*pbuf_even = *dbuf++; |
||||||
|
EIEIO; |
||||||
|
*pbuf_odd = *dbuf++; |
||||||
|
} |
||||||
|
} |
||||||
|
|
||||||
|
void ide_output_data_shorts(int dev, ushort *sect_buf, int shorts) |
||||||
|
{ |
||||||
|
uchar *dbuf; |
||||||
|
volatile uchar *pbuf_even; |
||||||
|
volatile uchar *pbuf_odd; |
||||||
|
|
||||||
|
pbuf_even = (uchar *) (ATA_CURR_BASE(dev) + ATA_DATA_EVEN); |
||||||
|
pbuf_odd = (uchar *) (ATA_CURR_BASE(dev) + ATA_DATA_ODD); |
||||||
|
dbuf = (uchar *) sect_buf; |
||||||
|
while (shorts--) { |
||||||
|
EIEIO; |
||||||
|
*pbuf_even = *dbuf++; |
||||||
|
EIEIO; |
||||||
|
*pbuf_odd = *dbuf++; |
||||||
|
} |
||||||
|
} |
Loading…
Reference in new issue