132 lines
3.2 KiB
C
132 lines
3.2 KiB
C
/*
|
|
* 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 <config.h>
|
|
#include <common.h>
|
|
#include <mmc.h>
|
|
#include <asm/errno.h>
|
|
#include <asm/arch/hardware.h>
|
|
#include <part.h>
|
|
#include <fat.h>
|
|
#include "mmc_hw.h"
|
|
#include <asm/arch/spi.h>
|
|
|
|
#ifdef CONFIG_MMC
|
|
|
|
#undef MMC_DEBUG
|
|
|
|
static block_dev_desc_t mmc_dev;
|
|
|
|
/* these are filled out by a call to mmc_hw_get_parameters */
|
|
static int hw_size; /* in kbytes */
|
|
static int hw_nr_sects;
|
|
static int hw_sect_size; /* in bytes */
|
|
|
|
block_dev_desc_t * mmc_get_dev(int dev)
|
|
{
|
|
return (block_dev_desc_t *)(&mmc_dev);
|
|
}
|
|
|
|
unsigned long mmc_block_read(int dev,
|
|
unsigned long start,
|
|
lbaint_t blkcnt,
|
|
void *buffer)
|
|
{
|
|
unsigned long rc = 0;
|
|
unsigned char *p = (unsigned char *)buffer;
|
|
unsigned long i;
|
|
unsigned long addr = start;
|
|
|
|
#ifdef MMC_DEBUG
|
|
printf("mmc_block_read: start=%lu, blkcnt=%lu\n", start,
|
|
(unsigned long)blkcnt);
|
|
#endif
|
|
|
|
for(i = 0; i < (unsigned long)blkcnt; i++) {
|
|
#ifdef MMC_DEBUG
|
|
printf("mmc_read_sector: addr=%lu, buffer=%p\n", addr, p);
|
|
#endif
|
|
(void)mmc_read_sector(addr, p);
|
|
rc++;
|
|
addr++;
|
|
p += hw_sect_size;
|
|
}
|
|
|
|
return rc;
|
|
}
|
|
|
|
/*-----------------------------------------------------------------------------
|
|
* Read hardware paramterers (sector size, size, number of sectors)
|
|
*/
|
|
static int mmc_hw_get_parameters(void)
|
|
{
|
|
unsigned char csddata[16];
|
|
unsigned int sizemult;
|
|
unsigned int size;
|
|
|
|
mmc_read_csd(csddata);
|
|
hw_sect_size = 1<<(csddata[5] & 0x0f);
|
|
size = ((csddata[6]&0x03)<<10)+(csddata[7]<<2)+(csddata[8]&0xc0);
|
|
sizemult = ((csddata[10] & 0x80)>>7)+((csddata[9] & 0x03)<<1);
|
|
hw_nr_sects = (size+1)*(1<<(sizemult+2));
|
|
hw_size = hw_nr_sects*hw_sect_size/1024;
|
|
|
|
#ifdef MMC_DEBUG
|
|
printf("mmc_hw_get_parameters: hw_sect_size=%d, hw_nr_sects=%d, "
|
|
"hw_size=%d\n", hw_sect_size, hw_nr_sects, hw_size);
|
|
#endif
|
|
|
|
return 0;
|
|
}
|
|
|
|
int mmc_legacy_init(int verbose)
|
|
{
|
|
int ret = -ENODEV;
|
|
|
|
if (verbose)
|
|
printf("mmc_legacy_init\n");
|
|
|
|
spi_init();
|
|
/* this meeds to be done twice */
|
|
mmc_hw_init();
|
|
udelay(1000);
|
|
mmc_hw_init();
|
|
|
|
mmc_hw_get_parameters();
|
|
|
|
mmc_dev.if_type = IF_TYPE_MMC;
|
|
mmc_dev.part_type = PART_TYPE_DOS;
|
|
mmc_dev.dev = 0;
|
|
mmc_dev.lun = 0;
|
|
mmc_dev.type = 0;
|
|
mmc_dev.blksz = hw_sect_size;
|
|
mmc_dev.lba = hw_nr_sects;
|
|
sprintf((char*)mmc_dev.vendor, "Unknown vendor");
|
|
sprintf((char*)mmc_dev.product, "Unknown product");
|
|
sprintf((char*)mmc_dev.revision, "N/A");
|
|
mmc_dev.removable = 0; /* should be true??? */
|
|
mmc_dev.block_read = mmc_block_read;
|
|
|
|
fat_register_device(&mmc_dev, 1);
|
|
|
|
ret = 0;
|
|
|
|
return ret;
|
|
}
|
|
|
|
#endif /* CONFIG_MMC */
|