mtd: remove alauda driver
The driver has very low utility. Devices in question are limited to about 400kB/s and the only known user (me) discarded the hardware several years back. Signed-off-by: Joern Engel <joern@logfs.org> Signed-off-by: Brian Norris <computersforpeace@gmail.com> Signed-off-by: David Woodhouse <David.Woodhouse@intel.com>
This commit is contained in:
parent
b2ac037610
commit
ebc6e4b652
|
@ -433,13 +433,6 @@ config MTD_NAND_PLATFORM
|
||||||
devices. You will need to provide platform-specific functions
|
devices. You will need to provide platform-specific functions
|
||||||
via platform_data.
|
via platform_data.
|
||||||
|
|
||||||
config MTD_ALAUDA
|
|
||||||
tristate "MTD driver for Olympus MAUSB-10 and Fujifilm DPC-R1"
|
|
||||||
depends on USB
|
|
||||||
help
|
|
||||||
These two (and possibly other) Alauda-based cardreaders for
|
|
||||||
SmartMedia and xD allow raw flash access.
|
|
||||||
|
|
||||||
config MTD_NAND_ORION
|
config MTD_NAND_ORION
|
||||||
tristate "NAND Flash support for Marvell Orion SoC"
|
tristate "NAND Flash support for Marvell Orion SoC"
|
||||||
depends on PLAT_ORION
|
depends on PLAT_ORION
|
||||||
|
|
|
@ -31,7 +31,6 @@ obj-$(CONFIG_MTD_NAND_CM_X270) += cmx270_nand.o
|
||||||
obj-$(CONFIG_MTD_NAND_PXA3xx) += pxa3xx_nand.o
|
obj-$(CONFIG_MTD_NAND_PXA3xx) += pxa3xx_nand.o
|
||||||
obj-$(CONFIG_MTD_NAND_TMIO) += tmio_nand.o
|
obj-$(CONFIG_MTD_NAND_TMIO) += tmio_nand.o
|
||||||
obj-$(CONFIG_MTD_NAND_PLATFORM) += plat_nand.o
|
obj-$(CONFIG_MTD_NAND_PLATFORM) += plat_nand.o
|
||||||
obj-$(CONFIG_MTD_ALAUDA) += alauda.o
|
|
||||||
obj-$(CONFIG_MTD_NAND_PASEMI) += pasemi_nand.o
|
obj-$(CONFIG_MTD_NAND_PASEMI) += pasemi_nand.o
|
||||||
obj-$(CONFIG_MTD_NAND_ORION) += orion_nand.o
|
obj-$(CONFIG_MTD_NAND_ORION) += orion_nand.o
|
||||||
obj-$(CONFIG_MTD_NAND_FSL_ELBC) += fsl_elbc_nand.o
|
obj-$(CONFIG_MTD_NAND_FSL_ELBC) += fsl_elbc_nand.o
|
||||||
|
|
|
@ -1,723 +0,0 @@
|
||||||
/*
|
|
||||||
* MTD driver for Alauda chips
|
|
||||||
*
|
|
||||||
* Copyright (C) 2007 Joern Engel <joern@logfs.org>
|
|
||||||
*
|
|
||||||
* Based on drivers/usb/usb-skeleton.c which is:
|
|
||||||
* Copyright (C) 2001-2004 Greg Kroah-Hartman (greg@kroah.com)
|
|
||||||
* and on drivers/usb/storage/alauda.c, which is:
|
|
||||||
* (c) 2005 Daniel Drake <dsd@gentoo.org>
|
|
||||||
*
|
|
||||||
* Idea and initial work by Arnd Bergmann <arnd@arndb.de>
|
|
||||||
*/
|
|
||||||
#include <linux/kernel.h>
|
|
||||||
#include <linux/errno.h>
|
|
||||||
#include <linux/init.h>
|
|
||||||
#include <linux/slab.h>
|
|
||||||
#include <linux/module.h>
|
|
||||||
#include <linux/kref.h>
|
|
||||||
#include <linux/usb.h>
|
|
||||||
#include <linux/mutex.h>
|
|
||||||
#include <linux/mtd/mtd.h>
|
|
||||||
#include <linux/mtd/nand_ecc.h>
|
|
||||||
|
|
||||||
/* Control commands */
|
|
||||||
#define ALAUDA_GET_XD_MEDIA_STATUS 0x08
|
|
||||||
#define ALAUDA_ACK_XD_MEDIA_CHANGE 0x0a
|
|
||||||
#define ALAUDA_GET_XD_MEDIA_SIG 0x86
|
|
||||||
|
|
||||||
/* Common prefix */
|
|
||||||
#define ALAUDA_BULK_CMD 0x40
|
|
||||||
|
|
||||||
/* The two ports */
|
|
||||||
#define ALAUDA_PORT_XD 0x00
|
|
||||||
#define ALAUDA_PORT_SM 0x01
|
|
||||||
|
|
||||||
/* Bulk commands */
|
|
||||||
#define ALAUDA_BULK_READ_PAGE 0x84
|
|
||||||
#define ALAUDA_BULK_READ_OOB 0x85 /* don't use, there's a chip bug */
|
|
||||||
#define ALAUDA_BULK_READ_BLOCK 0x94
|
|
||||||
#define ALAUDA_BULK_ERASE_BLOCK 0xa3
|
|
||||||
#define ALAUDA_BULK_WRITE_PAGE 0xa4
|
|
||||||
#define ALAUDA_BULK_WRITE_BLOCK 0xb4
|
|
||||||
#define ALAUDA_BULK_RESET_MEDIA 0xe0
|
|
||||||
|
|
||||||
/* Address shifting */
|
|
||||||
#define PBA_LO(pba) ((pba & 0xF) << 5)
|
|
||||||
#define PBA_HI(pba) (pba >> 3)
|
|
||||||
#define PBA_ZONE(pba) (pba >> 11)
|
|
||||||
|
|
||||||
#define TIMEOUT HZ
|
|
||||||
|
|
||||||
static const struct usb_device_id alauda_table[] = {
|
|
||||||
{ USB_DEVICE(0x0584, 0x0008) }, /* Fujifilm DPC-R1 */
|
|
||||||
{ USB_DEVICE(0x07b4, 0x010a) }, /* Olympus MAUSB-10 */
|
|
||||||
{ }
|
|
||||||
};
|
|
||||||
MODULE_DEVICE_TABLE(usb, alauda_table);
|
|
||||||
|
|
||||||
struct alauda_card {
|
|
||||||
u8 id; /* id byte */
|
|
||||||
u8 chipshift; /* 1<<chipshift total size */
|
|
||||||
u8 pageshift; /* 1<<pageshift page size */
|
|
||||||
u8 blockshift; /* 1<<blockshift block size */
|
|
||||||
};
|
|
||||||
|
|
||||||
struct alauda {
|
|
||||||
struct usb_device *dev;
|
|
||||||
struct usb_interface *interface;
|
|
||||||
struct mtd_info *mtd;
|
|
||||||
struct alauda_card *card;
|
|
||||||
struct mutex card_mutex;
|
|
||||||
u32 pagemask;
|
|
||||||
u32 bytemask;
|
|
||||||
u32 blockmask;
|
|
||||||
unsigned int write_out;
|
|
||||||
unsigned int bulk_in;
|
|
||||||
unsigned int bulk_out;
|
|
||||||
u8 port;
|
|
||||||
struct kref kref;
|
|
||||||
};
|
|
||||||
|
|
||||||
static struct alauda_card alauda_card_ids[] = {
|
|
||||||
/* NAND flash */
|
|
||||||
{ 0x6e, 20, 8, 12}, /* 1 MB */
|
|
||||||
{ 0xe8, 20, 8, 12}, /* 1 MB */
|
|
||||||
{ 0xec, 20, 8, 12}, /* 1 MB */
|
|
||||||
{ 0x64, 21, 8, 12}, /* 2 MB */
|
|
||||||
{ 0xea, 21, 8, 12}, /* 2 MB */
|
|
||||||
{ 0x6b, 22, 9, 13}, /* 4 MB */
|
|
||||||
{ 0xe3, 22, 9, 13}, /* 4 MB */
|
|
||||||
{ 0xe5, 22, 9, 13}, /* 4 MB */
|
|
||||||
{ 0xe6, 23, 9, 13}, /* 8 MB */
|
|
||||||
{ 0x73, 24, 9, 14}, /* 16 MB */
|
|
||||||
{ 0x75, 25, 9, 14}, /* 32 MB */
|
|
||||||
{ 0x76, 26, 9, 14}, /* 64 MB */
|
|
||||||
{ 0x79, 27, 9, 14}, /* 128 MB */
|
|
||||||
{ 0x71, 28, 9, 14}, /* 256 MB */
|
|
||||||
|
|
||||||
/* MASK ROM */
|
|
||||||
{ 0x5d, 21, 9, 13}, /* 2 MB */
|
|
||||||
{ 0xd5, 22, 9, 13}, /* 4 MB */
|
|
||||||
{ 0xd6, 23, 9, 13}, /* 8 MB */
|
|
||||||
{ 0x57, 24, 9, 13}, /* 16 MB */
|
|
||||||
{ 0x58, 25, 9, 13}, /* 32 MB */
|
|
||||||
{ }
|
|
||||||
};
|
|
||||||
|
|
||||||
static struct alauda_card *get_card(u8 id)
|
|
||||||
{
|
|
||||||
struct alauda_card *card;
|
|
||||||
|
|
||||||
for (card = alauda_card_ids; card->id; card++)
|
|
||||||
if (card->id == id)
|
|
||||||
return card;
|
|
||||||
return NULL;
|
|
||||||
}
|
|
||||||
|
|
||||||
static void alauda_delete(struct kref *kref)
|
|
||||||
{
|
|
||||||
struct alauda *al = container_of(kref, struct alauda, kref);
|
|
||||||
|
|
||||||
if (al->mtd) {
|
|
||||||
mtd_device_unregister(al->mtd);
|
|
||||||
kfree(al->mtd);
|
|
||||||
}
|
|
||||||
usb_put_dev(al->dev);
|
|
||||||
kfree(al);
|
|
||||||
}
|
|
||||||
|
|
||||||
static int alauda_get_media_status(struct alauda *al, void *buf)
|
|
||||||
{
|
|
||||||
int ret;
|
|
||||||
|
|
||||||
mutex_lock(&al->card_mutex);
|
|
||||||
ret = usb_control_msg(al->dev, usb_rcvctrlpipe(al->dev, 0),
|
|
||||||
ALAUDA_GET_XD_MEDIA_STATUS, 0xc0, 0, 1, buf, 2, HZ);
|
|
||||||
mutex_unlock(&al->card_mutex);
|
|
||||||
return ret;
|
|
||||||
}
|
|
||||||
|
|
||||||
static int alauda_ack_media(struct alauda *al)
|
|
||||||
{
|
|
||||||
int ret;
|
|
||||||
|
|
||||||
mutex_lock(&al->card_mutex);
|
|
||||||
ret = usb_control_msg(al->dev, usb_sndctrlpipe(al->dev, 0),
|
|
||||||
ALAUDA_ACK_XD_MEDIA_CHANGE, 0x40, 0, 1, NULL, 0, HZ);
|
|
||||||
mutex_unlock(&al->card_mutex);
|
|
||||||
return ret;
|
|
||||||
}
|
|
||||||
|
|
||||||
static int alauda_get_media_signatures(struct alauda *al, void *buf)
|
|
||||||
{
|
|
||||||
int ret;
|
|
||||||
|
|
||||||
mutex_lock(&al->card_mutex);
|
|
||||||
ret = usb_control_msg(al->dev, usb_rcvctrlpipe(al->dev, 0),
|
|
||||||
ALAUDA_GET_XD_MEDIA_SIG, 0xc0, 0, 0, buf, 4, HZ);
|
|
||||||
mutex_unlock(&al->card_mutex);
|
|
||||||
return ret;
|
|
||||||
}
|
|
||||||
|
|
||||||
static void alauda_reset(struct alauda *al)
|
|
||||||
{
|
|
||||||
u8 command[] = {
|
|
||||||
ALAUDA_BULK_CMD, ALAUDA_BULK_RESET_MEDIA, 0, 0,
|
|
||||||
0, 0, 0, 0, al->port
|
|
||||||
};
|
|
||||||
mutex_lock(&al->card_mutex);
|
|
||||||
usb_bulk_msg(al->dev, al->bulk_out, command, 9, NULL, HZ);
|
|
||||||
mutex_unlock(&al->card_mutex);
|
|
||||||
}
|
|
||||||
|
|
||||||
static void correct_data(void *buf, void *read_ecc,
|
|
||||||
int *corrected, int *uncorrected)
|
|
||||||
{
|
|
||||||
u8 calc_ecc[3];
|
|
||||||
int err;
|
|
||||||
|
|
||||||
nand_calculate_ecc(NULL, buf, calc_ecc);
|
|
||||||
err = nand_correct_data(NULL, buf, read_ecc, calc_ecc);
|
|
||||||
if (err) {
|
|
||||||
if (err > 0)
|
|
||||||
(*corrected)++;
|
|
||||||
else
|
|
||||||
(*uncorrected)++;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
struct alauda_sg_request {
|
|
||||||
struct urb *urb[3];
|
|
||||||
struct completion comp;
|
|
||||||
};
|
|
||||||
|
|
||||||
static void alauda_complete(struct urb *urb)
|
|
||||||
{
|
|
||||||
struct completion *comp = urb->context;
|
|
||||||
|
|
||||||
if (comp)
|
|
||||||
complete(comp);
|
|
||||||
}
|
|
||||||
|
|
||||||
static int __alauda_read_page(struct mtd_info *mtd, loff_t from, void *buf,
|
|
||||||
void *oob)
|
|
||||||
{
|
|
||||||
struct alauda_sg_request sg;
|
|
||||||
struct alauda *al = mtd->priv;
|
|
||||||
u32 pba = from >> al->card->blockshift;
|
|
||||||
u32 page = (from >> al->card->pageshift) & al->pagemask;
|
|
||||||
u8 command[] = {
|
|
||||||
ALAUDA_BULK_CMD, ALAUDA_BULK_READ_PAGE, PBA_HI(pba),
|
|
||||||
PBA_ZONE(pba), 0, PBA_LO(pba) + page, 1, 0, al->port
|
|
||||||
};
|
|
||||||
int i, err;
|
|
||||||
|
|
||||||
for (i=0; i<3; i++)
|
|
||||||
sg.urb[i] = NULL;
|
|
||||||
|
|
||||||
err = -ENOMEM;
|
|
||||||
for (i=0; i<3; i++) {
|
|
||||||
sg.urb[i] = usb_alloc_urb(0, GFP_NOIO);
|
|
||||||
if (!sg.urb[i])
|
|
||||||
goto out;
|
|
||||||
}
|
|
||||||
init_completion(&sg.comp);
|
|
||||||
usb_fill_bulk_urb(sg.urb[0], al->dev, al->bulk_out, command, 9,
|
|
||||||
alauda_complete, NULL);
|
|
||||||
usb_fill_bulk_urb(sg.urb[1], al->dev, al->bulk_in, buf, mtd->writesize,
|
|
||||||
alauda_complete, NULL);
|
|
||||||
usb_fill_bulk_urb(sg.urb[2], al->dev, al->bulk_in, oob, 16,
|
|
||||||
alauda_complete, &sg.comp);
|
|
||||||
|
|
||||||
mutex_lock(&al->card_mutex);
|
|
||||||
for (i=0; i<3; i++) {
|
|
||||||
err = usb_submit_urb(sg.urb[i], GFP_NOIO);
|
|
||||||
if (err)
|
|
||||||
goto cancel;
|
|
||||||
}
|
|
||||||
if (!wait_for_completion_timeout(&sg.comp, TIMEOUT)) {
|
|
||||||
err = -ETIMEDOUT;
|
|
||||||
cancel:
|
|
||||||
for (i=0; i<3; i++) {
|
|
||||||
usb_kill_urb(sg.urb[i]);
|
|
||||||
}
|
|
||||||
}
|
|
||||||
mutex_unlock(&al->card_mutex);
|
|
||||||
|
|
||||||
out:
|
|
||||||
usb_free_urb(sg.urb[0]);
|
|
||||||
usb_free_urb(sg.urb[1]);
|
|
||||||
usb_free_urb(sg.urb[2]);
|
|
||||||
return err;
|
|
||||||
}
|
|
||||||
|
|
||||||
static int alauda_read_page(struct mtd_info *mtd, loff_t from,
|
|
||||||
void *buf, u8 *oob, int *corrected, int *uncorrected)
|
|
||||||
{
|
|
||||||
int err;
|
|
||||||
|
|
||||||
err = __alauda_read_page(mtd, from, buf, oob);
|
|
||||||
if (err)
|
|
||||||
return err;
|
|
||||||
correct_data(buf, oob+13, corrected, uncorrected);
|
|
||||||
correct_data(buf+256, oob+8, corrected, uncorrected);
|
|
||||||
return 0;
|
|
||||||
}
|
|
||||||
|
|
||||||
static int alauda_write_page(struct mtd_info *mtd, loff_t to, void *buf,
|
|
||||||
void *oob)
|
|
||||||
{
|
|
||||||
struct alauda_sg_request sg;
|
|
||||||
struct alauda *al = mtd->priv;
|
|
||||||
u32 pba = to >> al->card->blockshift;
|
|
||||||
u32 page = (to >> al->card->pageshift) & al->pagemask;
|
|
||||||
u8 command[] = {
|
|
||||||
ALAUDA_BULK_CMD, ALAUDA_BULK_WRITE_PAGE, PBA_HI(pba),
|
|
||||||
PBA_ZONE(pba), 0, PBA_LO(pba) + page, 32, 0, al->port
|
|
||||||
};
|
|
||||||
int i, err;
|
|
||||||
|
|
||||||
for (i=0; i<3; i++)
|
|
||||||
sg.urb[i] = NULL;
|
|
||||||
|
|
||||||
err = -ENOMEM;
|
|
||||||
for (i=0; i<3; i++) {
|
|
||||||
sg.urb[i] = usb_alloc_urb(0, GFP_NOIO);
|
|
||||||
if (!sg.urb[i])
|
|
||||||
goto out;
|
|
||||||
}
|
|
||||||
init_completion(&sg.comp);
|
|
||||||
usb_fill_bulk_urb(sg.urb[0], al->dev, al->bulk_out, command, 9,
|
|
||||||
alauda_complete, NULL);
|
|
||||||
usb_fill_bulk_urb(sg.urb[1], al->dev, al->write_out, buf,mtd->writesize,
|
|
||||||
alauda_complete, NULL);
|
|
||||||
usb_fill_bulk_urb(sg.urb[2], al->dev, al->write_out, oob, 16,
|
|
||||||
alauda_complete, &sg.comp);
|
|
||||||
|
|
||||||
mutex_lock(&al->card_mutex);
|
|
||||||
for (i=0; i<3; i++) {
|
|
||||||
err = usb_submit_urb(sg.urb[i], GFP_NOIO);
|
|
||||||
if (err)
|
|
||||||
goto cancel;
|
|
||||||
}
|
|
||||||
if (!wait_for_completion_timeout(&sg.comp, TIMEOUT)) {
|
|
||||||
err = -ETIMEDOUT;
|
|
||||||
cancel:
|
|
||||||
for (i=0; i<3; i++) {
|
|
||||||
usb_kill_urb(sg.urb[i]);
|
|
||||||
}
|
|
||||||
}
|
|
||||||
mutex_unlock(&al->card_mutex);
|
|
||||||
|
|
||||||
out:
|
|
||||||
usb_free_urb(sg.urb[0]);
|
|
||||||
usb_free_urb(sg.urb[1]);
|
|
||||||
usb_free_urb(sg.urb[2]);
|
|
||||||
return err;
|
|
||||||
}
|
|
||||||
|
|
||||||
static int alauda_erase_block(struct mtd_info *mtd, loff_t ofs)
|
|
||||||
{
|
|
||||||
struct alauda_sg_request sg;
|
|
||||||
struct alauda *al = mtd->priv;
|
|
||||||
u32 pba = ofs >> al->card->blockshift;
|
|
||||||
u8 command[] = {
|
|
||||||
ALAUDA_BULK_CMD, ALAUDA_BULK_ERASE_BLOCK, PBA_HI(pba),
|
|
||||||
PBA_ZONE(pba), 0, PBA_LO(pba), 0x02, 0, al->port
|
|
||||||
};
|
|
||||||
u8 buf[2];
|
|
||||||
int i, err;
|
|
||||||
|
|
||||||
for (i=0; i<2; i++)
|
|
||||||
sg.urb[i] = NULL;
|
|
||||||
|
|
||||||
err = -ENOMEM;
|
|
||||||
for (i=0; i<2; i++) {
|
|
||||||
sg.urb[i] = usb_alloc_urb(0, GFP_NOIO);
|
|
||||||
if (!sg.urb[i])
|
|
||||||
goto out;
|
|
||||||
}
|
|
||||||
init_completion(&sg.comp);
|
|
||||||
usb_fill_bulk_urb(sg.urb[0], al->dev, al->bulk_out, command, 9,
|
|
||||||
alauda_complete, NULL);
|
|
||||||
usb_fill_bulk_urb(sg.urb[1], al->dev, al->bulk_in, buf, 2,
|
|
||||||
alauda_complete, &sg.comp);
|
|
||||||
|
|
||||||
mutex_lock(&al->card_mutex);
|
|
||||||
for (i=0; i<2; i++) {
|
|
||||||
err = usb_submit_urb(sg.urb[i], GFP_NOIO);
|
|
||||||
if (err)
|
|
||||||
goto cancel;
|
|
||||||
}
|
|
||||||
if (!wait_for_completion_timeout(&sg.comp, TIMEOUT)) {
|
|
||||||
err = -ETIMEDOUT;
|
|
||||||
cancel:
|
|
||||||
for (i=0; i<2; i++) {
|
|
||||||
usb_kill_urb(sg.urb[i]);
|
|
||||||
}
|
|
||||||
}
|
|
||||||
mutex_unlock(&al->card_mutex);
|
|
||||||
|
|
||||||
out:
|
|
||||||
usb_free_urb(sg.urb[0]);
|
|
||||||
usb_free_urb(sg.urb[1]);
|
|
||||||
return err;
|
|
||||||
}
|
|
||||||
|
|
||||||
static int alauda_read_oob(struct mtd_info *mtd, loff_t from, void *oob)
|
|
||||||
{
|
|
||||||
static u8 ignore_buf[512]; /* write only */
|
|
||||||
|
|
||||||
return __alauda_read_page(mtd, from, ignore_buf, oob);
|
|
||||||
}
|
|
||||||
|
|
||||||
static int alauda_isbad(struct mtd_info *mtd, loff_t ofs)
|
|
||||||
{
|
|
||||||
u8 oob[16];
|
|
||||||
int err;
|
|
||||||
|
|
||||||
err = alauda_read_oob(mtd, ofs, oob);
|
|
||||||
if (err)
|
|
||||||
return err;
|
|
||||||
|
|
||||||
/* A block is marked bad if two or more bits are zero */
|
|
||||||
return hweight8(oob[5]) >= 7 ? 0 : 1;
|
|
||||||
}
|
|
||||||
|
|
||||||
static int alauda_bounce_read(struct mtd_info *mtd, loff_t from, size_t len,
|
|
||||||
size_t *retlen, u_char *buf)
|
|
||||||
{
|
|
||||||
struct alauda *al = mtd->priv;
|
|
||||||
void *bounce_buf;
|
|
||||||
int err, corrected=0, uncorrected=0;
|
|
||||||
|
|
||||||
bounce_buf = kmalloc(mtd->writesize, GFP_KERNEL);
|
|
||||||
if (!bounce_buf)
|
|
||||||
return -ENOMEM;
|
|
||||||
|
|
||||||
*retlen = len;
|
|
||||||
while (len) {
|
|
||||||
u8 oob[16];
|
|
||||||
size_t byte = from & al->bytemask;
|
|
||||||
size_t cplen = min(len, mtd->writesize - byte);
|
|
||||||
|
|
||||||
err = alauda_read_page(mtd, from, bounce_buf, oob,
|
|
||||||
&corrected, &uncorrected);
|
|
||||||
if (err)
|
|
||||||
goto out;
|
|
||||||
|
|
||||||
memcpy(buf, bounce_buf + byte, cplen);
|
|
||||||
buf += cplen;
|
|
||||||
from += cplen;
|
|
||||||
len -= cplen;
|
|
||||||
}
|
|
||||||
err = 0;
|
|
||||||
if (corrected)
|
|
||||||
err = 1; /* return max_bitflips per ecc step */
|
|
||||||
if (uncorrected)
|
|
||||||
err = -EBADMSG;
|
|
||||||
out:
|
|
||||||
kfree(bounce_buf);
|
|
||||||
return err;
|
|
||||||
}
|
|
||||||
|
|
||||||
static int alauda_read(struct mtd_info *mtd, loff_t from, size_t len,
|
|
||||||
size_t *retlen, u_char *buf)
|
|
||||||
{
|
|
||||||
struct alauda *al = mtd->priv;
|
|
||||||
int err, corrected=0, uncorrected=0;
|
|
||||||
|
|
||||||
if ((from & al->bytemask) || (len & al->bytemask))
|
|
||||||
return alauda_bounce_read(mtd, from, len, retlen, buf);
|
|
||||||
|
|
||||||
*retlen = len;
|
|
||||||
while (len) {
|
|
||||||
u8 oob[16];
|
|
||||||
|
|
||||||
err = alauda_read_page(mtd, from, buf, oob,
|
|
||||||
&corrected, &uncorrected);
|
|
||||||
if (err)
|
|
||||||
return err;
|
|
||||||
|
|
||||||
buf += mtd->writesize;
|
|
||||||
from += mtd->writesize;
|
|
||||||
len -= mtd->writesize;
|
|
||||||
}
|
|
||||||
err = 0;
|
|
||||||
if (corrected)
|
|
||||||
err = 1; /* return max_bitflips per ecc step */
|
|
||||||
if (uncorrected)
|
|
||||||
err = -EBADMSG;
|
|
||||||
return err;
|
|
||||||
}
|
|
||||||
|
|
||||||
static int alauda_write(struct mtd_info *mtd, loff_t to, size_t len,
|
|
||||||
size_t *retlen, const u_char *buf)
|
|
||||||
{
|
|
||||||
struct alauda *al = mtd->priv;
|
|
||||||
int err;
|
|
||||||
|
|
||||||
if ((to & al->bytemask) || (len & al->bytemask))
|
|
||||||
return -EINVAL;
|
|
||||||
|
|
||||||
*retlen = len;
|
|
||||||
while (len) {
|
|
||||||
u32 page = (to >> al->card->pageshift) & al->pagemask;
|
|
||||||
u8 oob[16] = { 'h', 'e', 'l', 'l', 'o', 0xff, 0xff, 0xff,
|
|
||||||
0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff};
|
|
||||||
|
|
||||||
/* don't write to bad blocks */
|
|
||||||
if (page == 0) {
|
|
||||||
err = alauda_isbad(mtd, to);
|
|
||||||
if (err) {
|
|
||||||
return -EIO;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
nand_calculate_ecc(mtd, buf, &oob[13]);
|
|
||||||
nand_calculate_ecc(mtd, buf+256, &oob[8]);
|
|
||||||
|
|
||||||
err = alauda_write_page(mtd, to, (void*)buf, oob);
|
|
||||||
if (err)
|
|
||||||
return err;
|
|
||||||
|
|
||||||
buf += mtd->writesize;
|
|
||||||
to += mtd->writesize;
|
|
||||||
len -= mtd->writesize;
|
|
||||||
}
|
|
||||||
return 0;
|
|
||||||
}
|
|
||||||
|
|
||||||
static int __alauda_erase(struct mtd_info *mtd, struct erase_info *instr)
|
|
||||||
{
|
|
||||||
struct alauda *al = mtd->priv;
|
|
||||||
u32 ofs = instr->addr;
|
|
||||||
u32 len = instr->len;
|
|
||||||
int err;
|
|
||||||
|
|
||||||
if ((ofs & al->blockmask) || (len & al->blockmask))
|
|
||||||
return -EINVAL;
|
|
||||||
|
|
||||||
while (len) {
|
|
||||||
/* don't erase bad blocks */
|
|
||||||
err = alauda_isbad(mtd, ofs);
|
|
||||||
if (err > 0)
|
|
||||||
err = -EIO;
|
|
||||||
if (err < 0)
|
|
||||||
return err;
|
|
||||||
|
|
||||||
err = alauda_erase_block(mtd, ofs);
|
|
||||||
if (err < 0)
|
|
||||||
return err;
|
|
||||||
|
|
||||||
ofs += mtd->erasesize;
|
|
||||||
len -= mtd->erasesize;
|
|
||||||
}
|
|
||||||
return 0;
|
|
||||||
}
|
|
||||||
|
|
||||||
static int alauda_erase(struct mtd_info *mtd, struct erase_info *instr)
|
|
||||||
{
|
|
||||||
int err;
|
|
||||||
|
|
||||||
err = __alauda_erase(mtd, instr);
|
|
||||||
instr->state = err ? MTD_ERASE_FAILED : MTD_ERASE_DONE;
|
|
||||||
mtd_erase_callback(instr);
|
|
||||||
return err;
|
|
||||||
}
|
|
||||||
|
|
||||||
static int alauda_init_media(struct alauda *al)
|
|
||||||
{
|
|
||||||
u8 buf[4], *b0=buf, *b1=buf+1;
|
|
||||||
struct alauda_card *card;
|
|
||||||
struct mtd_info *mtd;
|
|
||||||
int err;
|
|
||||||
|
|
||||||
mtd = kzalloc(sizeof(*mtd), GFP_KERNEL);
|
|
||||||
if (!mtd)
|
|
||||||
return -ENOMEM;
|
|
||||||
|
|
||||||
for (;;) {
|
|
||||||
err = alauda_get_media_status(al, buf);
|
|
||||||
if (err < 0)
|
|
||||||
goto error;
|
|
||||||
if (*b0 & 0x10)
|
|
||||||
break;
|
|
||||||
msleep(20);
|
|
||||||
}
|
|
||||||
|
|
||||||
err = alauda_ack_media(al);
|
|
||||||
if (err)
|
|
||||||
goto error;
|
|
||||||
|
|
||||||
msleep(10);
|
|
||||||
|
|
||||||
err = alauda_get_media_status(al, buf);
|
|
||||||
if (err < 0)
|
|
||||||
goto error;
|
|
||||||
|
|
||||||
if (*b0 != 0x14) {
|
|
||||||
/* media not ready */
|
|
||||||
err = -EIO;
|
|
||||||
goto error;
|
|
||||||
}
|
|
||||||
err = alauda_get_media_signatures(al, buf);
|
|
||||||
if (err < 0)
|
|
||||||
goto error;
|
|
||||||
|
|
||||||
card = get_card(*b1);
|
|
||||||
if (!card) {
|
|
||||||
printk(KERN_ERR"Alauda: unknown card id %02x\n", *b1);
|
|
||||||
err = -EIO;
|
|
||||||
goto error;
|
|
||||||
}
|
|
||||||
printk(KERN_INFO"pagesize=%x\nerasesize=%x\nsize=%xMiB\n",
|
|
||||||
1<<card->pageshift, 1<<card->blockshift,
|
|
||||||
1<<(card->chipshift-20));
|
|
||||||
al->card = card;
|
|
||||||
al->pagemask = (1 << (card->blockshift - card->pageshift)) - 1;
|
|
||||||
al->bytemask = (1 << card->pageshift) - 1;
|
|
||||||
al->blockmask = (1 << card->blockshift) - 1;
|
|
||||||
|
|
||||||
mtd->name = "alauda";
|
|
||||||
mtd->size = 1<<card->chipshift;
|
|
||||||
mtd->erasesize = 1<<card->blockshift;
|
|
||||||
mtd->writesize = 1<<card->pageshift;
|
|
||||||
mtd->type = MTD_NANDFLASH;
|
|
||||||
mtd->flags = MTD_CAP_NANDFLASH;
|
|
||||||
mtd->_read = alauda_read;
|
|
||||||
mtd->_write = alauda_write;
|
|
||||||
mtd->_erase = alauda_erase;
|
|
||||||
mtd->_block_isbad = alauda_isbad;
|
|
||||||
mtd->priv = al;
|
|
||||||
mtd->owner = THIS_MODULE;
|
|
||||||
mtd->ecc_strength = 1;
|
|
||||||
|
|
||||||
err = mtd_device_register(mtd, NULL, 0);
|
|
||||||
if (err) {
|
|
||||||
err = -ENFILE;
|
|
||||||
goto error;
|
|
||||||
}
|
|
||||||
|
|
||||||
al->mtd = mtd;
|
|
||||||
alauda_reset(al); /* no clue whether this is necessary */
|
|
||||||
return 0;
|
|
||||||
error:
|
|
||||||
kfree(mtd);
|
|
||||||
return err;
|
|
||||||
}
|
|
||||||
|
|
||||||
static int alauda_check_media(struct alauda *al)
|
|
||||||
{
|
|
||||||
u8 buf[2], *b0 = buf, *b1 = buf+1;
|
|
||||||
int err;
|
|
||||||
|
|
||||||
err = alauda_get_media_status(al, buf);
|
|
||||||
if (err < 0)
|
|
||||||
return err;
|
|
||||||
|
|
||||||
if ((*b1 & 0x01) == 0) {
|
|
||||||
/* door open */
|
|
||||||
return -EIO;
|
|
||||||
}
|
|
||||||
if ((*b0 & 0x80) || ((*b0 & 0x1F) == 0x10)) {
|
|
||||||
/* no media ? */
|
|
||||||
return -EIO;
|
|
||||||
}
|
|
||||||
if (*b0 & 0x08) {
|
|
||||||
/* media change ? */
|
|
||||||
return alauda_init_media(al);
|
|
||||||
}
|
|
||||||
return 0;
|
|
||||||
}
|
|
||||||
|
|
||||||
static int alauda_probe(struct usb_interface *interface,
|
|
||||||
const struct usb_device_id *id)
|
|
||||||
{
|
|
||||||
struct alauda *al;
|
|
||||||
struct usb_host_interface *iface;
|
|
||||||
struct usb_endpoint_descriptor *ep,
|
|
||||||
*ep_in=NULL, *ep_out=NULL, *ep_wr=NULL;
|
|
||||||
int i, err = -ENOMEM;
|
|
||||||
|
|
||||||
al = kzalloc(2*sizeof(*al), GFP_KERNEL);
|
|
||||||
if (!al)
|
|
||||||
goto error;
|
|
||||||
|
|
||||||
kref_init(&al->kref);
|
|
||||||
usb_set_intfdata(interface, al);
|
|
||||||
|
|
||||||
al->dev = usb_get_dev(interface_to_usbdev(interface));
|
|
||||||
al->interface = interface;
|
|
||||||
|
|
||||||
iface = interface->cur_altsetting;
|
|
||||||
for (i = 0; i < iface->desc.bNumEndpoints; ++i) {
|
|
||||||
ep = &iface->endpoint[i].desc;
|
|
||||||
|
|
||||||
if (usb_endpoint_is_bulk_in(ep)) {
|
|
||||||
ep_in = ep;
|
|
||||||
} else if (usb_endpoint_is_bulk_out(ep)) {
|
|
||||||
if (i==0)
|
|
||||||
ep_wr = ep;
|
|
||||||
else
|
|
||||||
ep_out = ep;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
err = -EIO;
|
|
||||||
if (!ep_wr || !ep_in || !ep_out)
|
|
||||||
goto error;
|
|
||||||
|
|
||||||
al->write_out = usb_sndbulkpipe(al->dev,
|
|
||||||
usb_endpoint_num(ep_wr));
|
|
||||||
al->bulk_in = usb_rcvbulkpipe(al->dev,
|
|
||||||
usb_endpoint_num(ep_in));
|
|
||||||
al->bulk_out = usb_sndbulkpipe(al->dev,
|
|
||||||
usb_endpoint_num(ep_out));
|
|
||||||
|
|
||||||
/* second device is identical up to now */
|
|
||||||
memcpy(al+1, al, sizeof(*al));
|
|
||||||
|
|
||||||
mutex_init(&al[0].card_mutex);
|
|
||||||
mutex_init(&al[1].card_mutex);
|
|
||||||
|
|
||||||
al[0].port = ALAUDA_PORT_XD;
|
|
||||||
al[1].port = ALAUDA_PORT_SM;
|
|
||||||
|
|
||||||
dev_info(&interface->dev, "alauda probed\n");
|
|
||||||
alauda_check_media(al);
|
|
||||||
alauda_check_media(al+1);
|
|
||||||
|
|
||||||
return 0;
|
|
||||||
|
|
||||||
error:
|
|
||||||
if (al)
|
|
||||||
kref_put(&al->kref, alauda_delete);
|
|
||||||
return err;
|
|
||||||
}
|
|
||||||
|
|
||||||
static void alauda_disconnect(struct usb_interface *interface)
|
|
||||||
{
|
|
||||||
struct alauda *al;
|
|
||||||
|
|
||||||
al = usb_get_intfdata(interface);
|
|
||||||
usb_set_intfdata(interface, NULL);
|
|
||||||
|
|
||||||
/* FIXME: prevent more I/O from starting */
|
|
||||||
|
|
||||||
/* decrement our usage count */
|
|
||||||
if (al)
|
|
||||||
kref_put(&al->kref, alauda_delete);
|
|
||||||
|
|
||||||
dev_info(&interface->dev, "alauda gone");
|
|
||||||
}
|
|
||||||
|
|
||||||
static struct usb_driver alauda_driver = {
|
|
||||||
.name = "alauda",
|
|
||||||
.probe = alauda_probe,
|
|
||||||
.disconnect = alauda_disconnect,
|
|
||||||
.id_table = alauda_table,
|
|
||||||
};
|
|
||||||
|
|
||||||
module_usb_driver(alauda_driver);
|
|
||||||
|
|
||||||
MODULE_LICENSE("GPL");
|
|
Loading…
Reference in New Issue