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