162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0-only 262306a36Sopenharmony_ci/* vmu-flash.c 362306a36Sopenharmony_ci * Driver for SEGA Dreamcast Visual Memory Unit 462306a36Sopenharmony_ci * 562306a36Sopenharmony_ci * Copyright (c) Adrian McMenamin 2002 - 2009 662306a36Sopenharmony_ci * Copyright (c) Paul Mundt 2001 762306a36Sopenharmony_ci */ 862306a36Sopenharmony_ci#include <linux/init.h> 962306a36Sopenharmony_ci#include <linux/slab.h> 1062306a36Sopenharmony_ci#include <linux/sched.h> 1162306a36Sopenharmony_ci#include <linux/delay.h> 1262306a36Sopenharmony_ci#include <linux/maple.h> 1362306a36Sopenharmony_ci#include <linux/mtd/mtd.h> 1462306a36Sopenharmony_ci#include <linux/mtd/map.h> 1562306a36Sopenharmony_ci 1662306a36Sopenharmony_cistruct vmu_cache { 1762306a36Sopenharmony_ci unsigned char *buffer; /* Cache */ 1862306a36Sopenharmony_ci unsigned int block; /* Which block was cached */ 1962306a36Sopenharmony_ci unsigned long jiffies_atc; /* When was it cached? */ 2062306a36Sopenharmony_ci int valid; 2162306a36Sopenharmony_ci}; 2262306a36Sopenharmony_ci 2362306a36Sopenharmony_cistruct mdev_part { 2462306a36Sopenharmony_ci struct maple_device *mdev; 2562306a36Sopenharmony_ci int partition; 2662306a36Sopenharmony_ci}; 2762306a36Sopenharmony_ci 2862306a36Sopenharmony_cistruct vmupart { 2962306a36Sopenharmony_ci u16 user_blocks; 3062306a36Sopenharmony_ci u16 root_block; 3162306a36Sopenharmony_ci u16 numblocks; 3262306a36Sopenharmony_ci char *name; 3362306a36Sopenharmony_ci struct vmu_cache *pcache; 3462306a36Sopenharmony_ci}; 3562306a36Sopenharmony_ci 3662306a36Sopenharmony_cistruct memcard { 3762306a36Sopenharmony_ci u16 tempA; 3862306a36Sopenharmony_ci u16 tempB; 3962306a36Sopenharmony_ci u32 partitions; 4062306a36Sopenharmony_ci u32 blocklen; 4162306a36Sopenharmony_ci u32 writecnt; 4262306a36Sopenharmony_ci u32 readcnt; 4362306a36Sopenharmony_ci u32 removable; 4462306a36Sopenharmony_ci int partition; 4562306a36Sopenharmony_ci int read; 4662306a36Sopenharmony_ci unsigned char *blockread; 4762306a36Sopenharmony_ci struct vmupart *parts; 4862306a36Sopenharmony_ci struct mtd_info *mtd; 4962306a36Sopenharmony_ci}; 5062306a36Sopenharmony_ci 5162306a36Sopenharmony_cistruct vmu_block { 5262306a36Sopenharmony_ci unsigned int num; /* block number */ 5362306a36Sopenharmony_ci unsigned int ofs; /* block offset */ 5462306a36Sopenharmony_ci}; 5562306a36Sopenharmony_ci 5662306a36Sopenharmony_cistatic struct vmu_block *ofs_to_block(unsigned long src_ofs, 5762306a36Sopenharmony_ci struct mtd_info *mtd, int partition) 5862306a36Sopenharmony_ci{ 5962306a36Sopenharmony_ci struct vmu_block *vblock; 6062306a36Sopenharmony_ci struct maple_device *mdev; 6162306a36Sopenharmony_ci struct memcard *card; 6262306a36Sopenharmony_ci struct mdev_part *mpart; 6362306a36Sopenharmony_ci int num; 6462306a36Sopenharmony_ci 6562306a36Sopenharmony_ci mpart = mtd->priv; 6662306a36Sopenharmony_ci mdev = mpart->mdev; 6762306a36Sopenharmony_ci card = maple_get_drvdata(mdev); 6862306a36Sopenharmony_ci 6962306a36Sopenharmony_ci if (src_ofs >= card->parts[partition].numblocks * card->blocklen) 7062306a36Sopenharmony_ci goto failed; 7162306a36Sopenharmony_ci 7262306a36Sopenharmony_ci num = src_ofs / card->blocklen; 7362306a36Sopenharmony_ci if (num > card->parts[partition].numblocks) 7462306a36Sopenharmony_ci goto failed; 7562306a36Sopenharmony_ci 7662306a36Sopenharmony_ci vblock = kmalloc(sizeof(struct vmu_block), GFP_KERNEL); 7762306a36Sopenharmony_ci if (!vblock) 7862306a36Sopenharmony_ci goto failed; 7962306a36Sopenharmony_ci 8062306a36Sopenharmony_ci vblock->num = num; 8162306a36Sopenharmony_ci vblock->ofs = src_ofs % card->blocklen; 8262306a36Sopenharmony_ci return vblock; 8362306a36Sopenharmony_ci 8462306a36Sopenharmony_cifailed: 8562306a36Sopenharmony_ci return NULL; 8662306a36Sopenharmony_ci} 8762306a36Sopenharmony_ci 8862306a36Sopenharmony_ci/* Maple bus callback function for reads */ 8962306a36Sopenharmony_cistatic void vmu_blockread(struct mapleq *mq) 9062306a36Sopenharmony_ci{ 9162306a36Sopenharmony_ci struct maple_device *mdev; 9262306a36Sopenharmony_ci struct memcard *card; 9362306a36Sopenharmony_ci 9462306a36Sopenharmony_ci mdev = mq->dev; 9562306a36Sopenharmony_ci card = maple_get_drvdata(mdev); 9662306a36Sopenharmony_ci /* copy the read in data */ 9762306a36Sopenharmony_ci 9862306a36Sopenharmony_ci if (unlikely(!card->blockread)) 9962306a36Sopenharmony_ci return; 10062306a36Sopenharmony_ci 10162306a36Sopenharmony_ci memcpy(card->blockread, mq->recvbuf->buf + 12, 10262306a36Sopenharmony_ci card->blocklen/card->readcnt); 10362306a36Sopenharmony_ci 10462306a36Sopenharmony_ci} 10562306a36Sopenharmony_ci 10662306a36Sopenharmony_ci/* Interface with maple bus to read blocks 10762306a36Sopenharmony_ci * caching the results so that other parts 10862306a36Sopenharmony_ci * of the driver can access block reads */ 10962306a36Sopenharmony_cistatic int maple_vmu_read_block(unsigned int num, unsigned char *buf, 11062306a36Sopenharmony_ci struct mtd_info *mtd) 11162306a36Sopenharmony_ci{ 11262306a36Sopenharmony_ci struct memcard *card; 11362306a36Sopenharmony_ci struct mdev_part *mpart; 11462306a36Sopenharmony_ci struct maple_device *mdev; 11562306a36Sopenharmony_ci int partition, error = 0, x, wait; 11662306a36Sopenharmony_ci unsigned char *blockread = NULL; 11762306a36Sopenharmony_ci struct vmu_cache *pcache; 11862306a36Sopenharmony_ci __be32 sendbuf; 11962306a36Sopenharmony_ci 12062306a36Sopenharmony_ci mpart = mtd->priv; 12162306a36Sopenharmony_ci mdev = mpart->mdev; 12262306a36Sopenharmony_ci partition = mpart->partition; 12362306a36Sopenharmony_ci card = maple_get_drvdata(mdev); 12462306a36Sopenharmony_ci pcache = card->parts[partition].pcache; 12562306a36Sopenharmony_ci pcache->valid = 0; 12662306a36Sopenharmony_ci 12762306a36Sopenharmony_ci /* prepare the cache for this block */ 12862306a36Sopenharmony_ci if (!pcache->buffer) { 12962306a36Sopenharmony_ci pcache->buffer = kmalloc(card->blocklen, GFP_KERNEL); 13062306a36Sopenharmony_ci if (!pcache->buffer) { 13162306a36Sopenharmony_ci dev_err(&mdev->dev, "VMU at (%d, %d) - read fails due" 13262306a36Sopenharmony_ci " to lack of memory\n", mdev->port, 13362306a36Sopenharmony_ci mdev->unit); 13462306a36Sopenharmony_ci error = -ENOMEM; 13562306a36Sopenharmony_ci goto outB; 13662306a36Sopenharmony_ci } 13762306a36Sopenharmony_ci } 13862306a36Sopenharmony_ci 13962306a36Sopenharmony_ci /* 14062306a36Sopenharmony_ci * Reads may be phased - again the hardware spec 14162306a36Sopenharmony_ci * supports this - though may not be any devices in 14262306a36Sopenharmony_ci * the wild that implement it, but we will here 14362306a36Sopenharmony_ci */ 14462306a36Sopenharmony_ci for (x = 0; x < card->readcnt; x++) { 14562306a36Sopenharmony_ci sendbuf = cpu_to_be32(partition << 24 | x << 16 | num); 14662306a36Sopenharmony_ci 14762306a36Sopenharmony_ci if (atomic_read(&mdev->busy) == 1) { 14862306a36Sopenharmony_ci wait_event_interruptible_timeout(mdev->maple_wait, 14962306a36Sopenharmony_ci atomic_read(&mdev->busy) == 0, HZ); 15062306a36Sopenharmony_ci if (atomic_read(&mdev->busy) == 1) { 15162306a36Sopenharmony_ci dev_notice(&mdev->dev, "VMU at (%d, %d)" 15262306a36Sopenharmony_ci " is busy\n", mdev->port, mdev->unit); 15362306a36Sopenharmony_ci error = -EAGAIN; 15462306a36Sopenharmony_ci goto outB; 15562306a36Sopenharmony_ci } 15662306a36Sopenharmony_ci } 15762306a36Sopenharmony_ci 15862306a36Sopenharmony_ci atomic_set(&mdev->busy, 1); 15962306a36Sopenharmony_ci blockread = kmalloc(card->blocklen/card->readcnt, GFP_KERNEL); 16062306a36Sopenharmony_ci if (!blockread) { 16162306a36Sopenharmony_ci error = -ENOMEM; 16262306a36Sopenharmony_ci atomic_set(&mdev->busy, 0); 16362306a36Sopenharmony_ci goto outB; 16462306a36Sopenharmony_ci } 16562306a36Sopenharmony_ci card->blockread = blockread; 16662306a36Sopenharmony_ci 16762306a36Sopenharmony_ci maple_getcond_callback(mdev, vmu_blockread, 0, 16862306a36Sopenharmony_ci MAPLE_FUNC_MEMCARD); 16962306a36Sopenharmony_ci error = maple_add_packet(mdev, MAPLE_FUNC_MEMCARD, 17062306a36Sopenharmony_ci MAPLE_COMMAND_BREAD, 2, &sendbuf); 17162306a36Sopenharmony_ci /* Very long timeouts seem to be needed when box is stressed */ 17262306a36Sopenharmony_ci wait = wait_event_interruptible_timeout(mdev->maple_wait, 17362306a36Sopenharmony_ci (atomic_read(&mdev->busy) == 0 || 17462306a36Sopenharmony_ci atomic_read(&mdev->busy) == 2), HZ * 3); 17562306a36Sopenharmony_ci /* 17662306a36Sopenharmony_ci * MTD layer does not handle hotplugging well 17762306a36Sopenharmony_ci * so have to return errors when VMU is unplugged 17862306a36Sopenharmony_ci * in the middle of a read (busy == 2) 17962306a36Sopenharmony_ci */ 18062306a36Sopenharmony_ci if (error || atomic_read(&mdev->busy) == 2) { 18162306a36Sopenharmony_ci if (atomic_read(&mdev->busy) == 2) 18262306a36Sopenharmony_ci error = -ENXIO; 18362306a36Sopenharmony_ci atomic_set(&mdev->busy, 0); 18462306a36Sopenharmony_ci card->blockread = NULL; 18562306a36Sopenharmony_ci goto outA; 18662306a36Sopenharmony_ci } 18762306a36Sopenharmony_ci if (wait == 0 || wait == -ERESTARTSYS) { 18862306a36Sopenharmony_ci card->blockread = NULL; 18962306a36Sopenharmony_ci atomic_set(&mdev->busy, 0); 19062306a36Sopenharmony_ci error = -EIO; 19162306a36Sopenharmony_ci list_del_init(&(mdev->mq->list)); 19262306a36Sopenharmony_ci kfree(mdev->mq->sendbuf); 19362306a36Sopenharmony_ci mdev->mq->sendbuf = NULL; 19462306a36Sopenharmony_ci if (wait == -ERESTARTSYS) { 19562306a36Sopenharmony_ci dev_warn(&mdev->dev, "VMU read on (%d, %d)" 19662306a36Sopenharmony_ci " interrupted on block 0x%X\n", 19762306a36Sopenharmony_ci mdev->port, mdev->unit, num); 19862306a36Sopenharmony_ci } else 19962306a36Sopenharmony_ci dev_notice(&mdev->dev, "VMU read on (%d, %d)" 20062306a36Sopenharmony_ci " timed out on block 0x%X\n", 20162306a36Sopenharmony_ci mdev->port, mdev->unit, num); 20262306a36Sopenharmony_ci goto outA; 20362306a36Sopenharmony_ci } 20462306a36Sopenharmony_ci 20562306a36Sopenharmony_ci memcpy(buf + (card->blocklen/card->readcnt) * x, blockread, 20662306a36Sopenharmony_ci card->blocklen/card->readcnt); 20762306a36Sopenharmony_ci 20862306a36Sopenharmony_ci memcpy(pcache->buffer + (card->blocklen/card->readcnt) * x, 20962306a36Sopenharmony_ci card->blockread, card->blocklen/card->readcnt); 21062306a36Sopenharmony_ci card->blockread = NULL; 21162306a36Sopenharmony_ci pcache->block = num; 21262306a36Sopenharmony_ci pcache->jiffies_atc = jiffies; 21362306a36Sopenharmony_ci pcache->valid = 1; 21462306a36Sopenharmony_ci kfree(blockread); 21562306a36Sopenharmony_ci } 21662306a36Sopenharmony_ci 21762306a36Sopenharmony_ci return error; 21862306a36Sopenharmony_ci 21962306a36Sopenharmony_cioutA: 22062306a36Sopenharmony_ci kfree(blockread); 22162306a36Sopenharmony_cioutB: 22262306a36Sopenharmony_ci return error; 22362306a36Sopenharmony_ci} 22462306a36Sopenharmony_ci 22562306a36Sopenharmony_ci/* communicate with maple bus for phased writing */ 22662306a36Sopenharmony_cistatic int maple_vmu_write_block(unsigned int num, const unsigned char *buf, 22762306a36Sopenharmony_ci struct mtd_info *mtd) 22862306a36Sopenharmony_ci{ 22962306a36Sopenharmony_ci struct memcard *card; 23062306a36Sopenharmony_ci struct mdev_part *mpart; 23162306a36Sopenharmony_ci struct maple_device *mdev; 23262306a36Sopenharmony_ci int partition, error, locking, x, phaselen, wait; 23362306a36Sopenharmony_ci __be32 *sendbuf; 23462306a36Sopenharmony_ci 23562306a36Sopenharmony_ci mpart = mtd->priv; 23662306a36Sopenharmony_ci mdev = mpart->mdev; 23762306a36Sopenharmony_ci partition = mpart->partition; 23862306a36Sopenharmony_ci card = maple_get_drvdata(mdev); 23962306a36Sopenharmony_ci 24062306a36Sopenharmony_ci phaselen = card->blocklen/card->writecnt; 24162306a36Sopenharmony_ci 24262306a36Sopenharmony_ci sendbuf = kmalloc(phaselen + 4, GFP_KERNEL); 24362306a36Sopenharmony_ci if (!sendbuf) { 24462306a36Sopenharmony_ci error = -ENOMEM; 24562306a36Sopenharmony_ci goto fail_nosendbuf; 24662306a36Sopenharmony_ci } 24762306a36Sopenharmony_ci for (x = 0; x < card->writecnt; x++) { 24862306a36Sopenharmony_ci sendbuf[0] = cpu_to_be32(partition << 24 | x << 16 | num); 24962306a36Sopenharmony_ci memcpy(&sendbuf[1], buf + phaselen * x, phaselen); 25062306a36Sopenharmony_ci /* wait until the device is not busy doing something else 25162306a36Sopenharmony_ci * or 1 second - which ever is longer */ 25262306a36Sopenharmony_ci if (atomic_read(&mdev->busy) == 1) { 25362306a36Sopenharmony_ci wait_event_interruptible_timeout(mdev->maple_wait, 25462306a36Sopenharmony_ci atomic_read(&mdev->busy) == 0, HZ); 25562306a36Sopenharmony_ci if (atomic_read(&mdev->busy) == 1) { 25662306a36Sopenharmony_ci error = -EBUSY; 25762306a36Sopenharmony_ci dev_notice(&mdev->dev, "VMU write at (%d, %d)" 25862306a36Sopenharmony_ci "failed - device is busy\n", 25962306a36Sopenharmony_ci mdev->port, mdev->unit); 26062306a36Sopenharmony_ci goto fail_nolock; 26162306a36Sopenharmony_ci } 26262306a36Sopenharmony_ci } 26362306a36Sopenharmony_ci atomic_set(&mdev->busy, 1); 26462306a36Sopenharmony_ci 26562306a36Sopenharmony_ci locking = maple_add_packet(mdev, MAPLE_FUNC_MEMCARD, 26662306a36Sopenharmony_ci MAPLE_COMMAND_BWRITE, phaselen / 4 + 2, sendbuf); 26762306a36Sopenharmony_ci wait = wait_event_interruptible_timeout(mdev->maple_wait, 26862306a36Sopenharmony_ci atomic_read(&mdev->busy) == 0, HZ/10); 26962306a36Sopenharmony_ci if (locking) { 27062306a36Sopenharmony_ci error = -EIO; 27162306a36Sopenharmony_ci atomic_set(&mdev->busy, 0); 27262306a36Sopenharmony_ci goto fail_nolock; 27362306a36Sopenharmony_ci } 27462306a36Sopenharmony_ci if (atomic_read(&mdev->busy) == 2) { 27562306a36Sopenharmony_ci atomic_set(&mdev->busy, 0); 27662306a36Sopenharmony_ci } else if (wait == 0 || wait == -ERESTARTSYS) { 27762306a36Sopenharmony_ci error = -EIO; 27862306a36Sopenharmony_ci dev_warn(&mdev->dev, "Write at (%d, %d) of block" 27962306a36Sopenharmony_ci " 0x%X at phase %d failed: could not" 28062306a36Sopenharmony_ci " communicate with VMU", mdev->port, 28162306a36Sopenharmony_ci mdev->unit, num, x); 28262306a36Sopenharmony_ci atomic_set(&mdev->busy, 0); 28362306a36Sopenharmony_ci kfree(mdev->mq->sendbuf); 28462306a36Sopenharmony_ci mdev->mq->sendbuf = NULL; 28562306a36Sopenharmony_ci list_del_init(&(mdev->mq->list)); 28662306a36Sopenharmony_ci goto fail_nolock; 28762306a36Sopenharmony_ci } 28862306a36Sopenharmony_ci } 28962306a36Sopenharmony_ci kfree(sendbuf); 29062306a36Sopenharmony_ci 29162306a36Sopenharmony_ci return card->blocklen; 29262306a36Sopenharmony_ci 29362306a36Sopenharmony_cifail_nolock: 29462306a36Sopenharmony_ci kfree(sendbuf); 29562306a36Sopenharmony_cifail_nosendbuf: 29662306a36Sopenharmony_ci dev_err(&mdev->dev, "VMU (%d, %d): write failed\n", mdev->port, 29762306a36Sopenharmony_ci mdev->unit); 29862306a36Sopenharmony_ci return error; 29962306a36Sopenharmony_ci} 30062306a36Sopenharmony_ci 30162306a36Sopenharmony_ci/* mtd function to simulate reading byte by byte */ 30262306a36Sopenharmony_cistatic unsigned char vmu_flash_read_char(unsigned long ofs, int *retval, 30362306a36Sopenharmony_ci struct mtd_info *mtd) 30462306a36Sopenharmony_ci{ 30562306a36Sopenharmony_ci struct vmu_block *vblock; 30662306a36Sopenharmony_ci struct memcard *card; 30762306a36Sopenharmony_ci struct mdev_part *mpart; 30862306a36Sopenharmony_ci struct maple_device *mdev; 30962306a36Sopenharmony_ci unsigned char *buf, ret; 31062306a36Sopenharmony_ci int partition, error; 31162306a36Sopenharmony_ci 31262306a36Sopenharmony_ci mpart = mtd->priv; 31362306a36Sopenharmony_ci mdev = mpart->mdev; 31462306a36Sopenharmony_ci partition = mpart->partition; 31562306a36Sopenharmony_ci card = maple_get_drvdata(mdev); 31662306a36Sopenharmony_ci *retval = 0; 31762306a36Sopenharmony_ci 31862306a36Sopenharmony_ci buf = kmalloc(card->blocklen, GFP_KERNEL); 31962306a36Sopenharmony_ci if (!buf) { 32062306a36Sopenharmony_ci *retval = 1; 32162306a36Sopenharmony_ci ret = -ENOMEM; 32262306a36Sopenharmony_ci goto finish; 32362306a36Sopenharmony_ci } 32462306a36Sopenharmony_ci 32562306a36Sopenharmony_ci vblock = ofs_to_block(ofs, mtd, partition); 32662306a36Sopenharmony_ci if (!vblock) { 32762306a36Sopenharmony_ci *retval = 3; 32862306a36Sopenharmony_ci ret = -ENOMEM; 32962306a36Sopenharmony_ci goto out_buf; 33062306a36Sopenharmony_ci } 33162306a36Sopenharmony_ci 33262306a36Sopenharmony_ci error = maple_vmu_read_block(vblock->num, buf, mtd); 33362306a36Sopenharmony_ci if (error) { 33462306a36Sopenharmony_ci ret = error; 33562306a36Sopenharmony_ci *retval = 2; 33662306a36Sopenharmony_ci goto out_vblock; 33762306a36Sopenharmony_ci } 33862306a36Sopenharmony_ci 33962306a36Sopenharmony_ci ret = buf[vblock->ofs]; 34062306a36Sopenharmony_ci 34162306a36Sopenharmony_ciout_vblock: 34262306a36Sopenharmony_ci kfree(vblock); 34362306a36Sopenharmony_ciout_buf: 34462306a36Sopenharmony_ci kfree(buf); 34562306a36Sopenharmony_cifinish: 34662306a36Sopenharmony_ci return ret; 34762306a36Sopenharmony_ci} 34862306a36Sopenharmony_ci 34962306a36Sopenharmony_ci/* mtd higher order function to read flash */ 35062306a36Sopenharmony_cistatic int vmu_flash_read(struct mtd_info *mtd, loff_t from, size_t len, 35162306a36Sopenharmony_ci size_t *retlen, u_char *buf) 35262306a36Sopenharmony_ci{ 35362306a36Sopenharmony_ci struct maple_device *mdev; 35462306a36Sopenharmony_ci struct memcard *card; 35562306a36Sopenharmony_ci struct mdev_part *mpart; 35662306a36Sopenharmony_ci struct vmu_cache *pcache; 35762306a36Sopenharmony_ci struct vmu_block *vblock; 35862306a36Sopenharmony_ci int index = 0, retval, partition, leftover, numblocks; 35962306a36Sopenharmony_ci unsigned char cx; 36062306a36Sopenharmony_ci 36162306a36Sopenharmony_ci mpart = mtd->priv; 36262306a36Sopenharmony_ci mdev = mpart->mdev; 36362306a36Sopenharmony_ci partition = mpart->partition; 36462306a36Sopenharmony_ci card = maple_get_drvdata(mdev); 36562306a36Sopenharmony_ci 36662306a36Sopenharmony_ci numblocks = card->parts[partition].numblocks; 36762306a36Sopenharmony_ci if (from + len > numblocks * card->blocklen) 36862306a36Sopenharmony_ci len = numblocks * card->blocklen - from; 36962306a36Sopenharmony_ci if (len == 0) 37062306a36Sopenharmony_ci return -EIO; 37162306a36Sopenharmony_ci /* Have we cached this bit already? */ 37262306a36Sopenharmony_ci pcache = card->parts[partition].pcache; 37362306a36Sopenharmony_ci do { 37462306a36Sopenharmony_ci vblock = ofs_to_block(from + index, mtd, partition); 37562306a36Sopenharmony_ci if (!vblock) 37662306a36Sopenharmony_ci return -ENOMEM; 37762306a36Sopenharmony_ci /* Have we cached this and is the cache valid and timely? */ 37862306a36Sopenharmony_ci if (pcache->valid && 37962306a36Sopenharmony_ci time_before(jiffies, pcache->jiffies_atc + HZ) && 38062306a36Sopenharmony_ci (pcache->block == vblock->num)) { 38162306a36Sopenharmony_ci /* we have cached it, so do necessary copying */ 38262306a36Sopenharmony_ci leftover = card->blocklen - vblock->ofs; 38362306a36Sopenharmony_ci if (vblock->ofs + len - index < card->blocklen) { 38462306a36Sopenharmony_ci /* only a bit of this block to copy */ 38562306a36Sopenharmony_ci memcpy(buf + index, 38662306a36Sopenharmony_ci pcache->buffer + vblock->ofs, 38762306a36Sopenharmony_ci len - index); 38862306a36Sopenharmony_ci index = len; 38962306a36Sopenharmony_ci } else { 39062306a36Sopenharmony_ci /* otherwise copy remainder of whole block */ 39162306a36Sopenharmony_ci memcpy(buf + index, pcache->buffer + 39262306a36Sopenharmony_ci vblock->ofs, leftover); 39362306a36Sopenharmony_ci index += leftover; 39462306a36Sopenharmony_ci } 39562306a36Sopenharmony_ci } else { 39662306a36Sopenharmony_ci /* 39762306a36Sopenharmony_ci * Not cached so read one byte - 39862306a36Sopenharmony_ci * but cache the rest of the block 39962306a36Sopenharmony_ci */ 40062306a36Sopenharmony_ci cx = vmu_flash_read_char(from + index, &retval, mtd); 40162306a36Sopenharmony_ci if (retval) { 40262306a36Sopenharmony_ci *retlen = index; 40362306a36Sopenharmony_ci kfree(vblock); 40462306a36Sopenharmony_ci return cx; 40562306a36Sopenharmony_ci } 40662306a36Sopenharmony_ci memset(buf + index, cx, 1); 40762306a36Sopenharmony_ci index++; 40862306a36Sopenharmony_ci } 40962306a36Sopenharmony_ci kfree(vblock); 41062306a36Sopenharmony_ci } while (len > index); 41162306a36Sopenharmony_ci *retlen = index; 41262306a36Sopenharmony_ci 41362306a36Sopenharmony_ci return 0; 41462306a36Sopenharmony_ci} 41562306a36Sopenharmony_ci 41662306a36Sopenharmony_cistatic int vmu_flash_write(struct mtd_info *mtd, loff_t to, size_t len, 41762306a36Sopenharmony_ci size_t *retlen, const u_char *buf) 41862306a36Sopenharmony_ci{ 41962306a36Sopenharmony_ci struct maple_device *mdev; 42062306a36Sopenharmony_ci struct memcard *card; 42162306a36Sopenharmony_ci struct mdev_part *mpart; 42262306a36Sopenharmony_ci int index = 0, partition, error = 0, numblocks; 42362306a36Sopenharmony_ci struct vmu_cache *pcache; 42462306a36Sopenharmony_ci struct vmu_block *vblock; 42562306a36Sopenharmony_ci unsigned char *buffer; 42662306a36Sopenharmony_ci 42762306a36Sopenharmony_ci mpart = mtd->priv; 42862306a36Sopenharmony_ci mdev = mpart->mdev; 42962306a36Sopenharmony_ci partition = mpart->partition; 43062306a36Sopenharmony_ci card = maple_get_drvdata(mdev); 43162306a36Sopenharmony_ci 43262306a36Sopenharmony_ci numblocks = card->parts[partition].numblocks; 43362306a36Sopenharmony_ci if (to + len > numblocks * card->blocklen) 43462306a36Sopenharmony_ci len = numblocks * card->blocklen - to; 43562306a36Sopenharmony_ci if (len == 0) { 43662306a36Sopenharmony_ci error = -EIO; 43762306a36Sopenharmony_ci goto failed; 43862306a36Sopenharmony_ci } 43962306a36Sopenharmony_ci 44062306a36Sopenharmony_ci vblock = ofs_to_block(to, mtd, partition); 44162306a36Sopenharmony_ci if (!vblock) { 44262306a36Sopenharmony_ci error = -ENOMEM; 44362306a36Sopenharmony_ci goto failed; 44462306a36Sopenharmony_ci } 44562306a36Sopenharmony_ci 44662306a36Sopenharmony_ci buffer = kmalloc(card->blocklen, GFP_KERNEL); 44762306a36Sopenharmony_ci if (!buffer) { 44862306a36Sopenharmony_ci error = -ENOMEM; 44962306a36Sopenharmony_ci goto fail_buffer; 45062306a36Sopenharmony_ci } 45162306a36Sopenharmony_ci 45262306a36Sopenharmony_ci do { 45362306a36Sopenharmony_ci /* Read in the block we are to write to */ 45462306a36Sopenharmony_ci error = maple_vmu_read_block(vblock->num, buffer, mtd); 45562306a36Sopenharmony_ci if (error) 45662306a36Sopenharmony_ci goto fail_io; 45762306a36Sopenharmony_ci 45862306a36Sopenharmony_ci do { 45962306a36Sopenharmony_ci buffer[vblock->ofs] = buf[index]; 46062306a36Sopenharmony_ci vblock->ofs++; 46162306a36Sopenharmony_ci index++; 46262306a36Sopenharmony_ci if (index >= len) 46362306a36Sopenharmony_ci break; 46462306a36Sopenharmony_ci } while (vblock->ofs < card->blocklen); 46562306a36Sopenharmony_ci 46662306a36Sopenharmony_ci /* write out new buffer */ 46762306a36Sopenharmony_ci error = maple_vmu_write_block(vblock->num, buffer, mtd); 46862306a36Sopenharmony_ci /* invalidate the cache */ 46962306a36Sopenharmony_ci pcache = card->parts[partition].pcache; 47062306a36Sopenharmony_ci pcache->valid = 0; 47162306a36Sopenharmony_ci 47262306a36Sopenharmony_ci if (error != card->blocklen) 47362306a36Sopenharmony_ci goto fail_io; 47462306a36Sopenharmony_ci 47562306a36Sopenharmony_ci vblock->num++; 47662306a36Sopenharmony_ci vblock->ofs = 0; 47762306a36Sopenharmony_ci } while (len > index); 47862306a36Sopenharmony_ci 47962306a36Sopenharmony_ci kfree(buffer); 48062306a36Sopenharmony_ci *retlen = index; 48162306a36Sopenharmony_ci kfree(vblock); 48262306a36Sopenharmony_ci return 0; 48362306a36Sopenharmony_ci 48462306a36Sopenharmony_cifail_io: 48562306a36Sopenharmony_ci kfree(buffer); 48662306a36Sopenharmony_cifail_buffer: 48762306a36Sopenharmony_ci kfree(vblock); 48862306a36Sopenharmony_cifailed: 48962306a36Sopenharmony_ci dev_err(&mdev->dev, "VMU write failing with error %d\n", error); 49062306a36Sopenharmony_ci return error; 49162306a36Sopenharmony_ci} 49262306a36Sopenharmony_ci 49362306a36Sopenharmony_cistatic void vmu_flash_sync(struct mtd_info *mtd) 49462306a36Sopenharmony_ci{ 49562306a36Sopenharmony_ci /* Do nothing here */ 49662306a36Sopenharmony_ci} 49762306a36Sopenharmony_ci 49862306a36Sopenharmony_ci/* Maple bus callback function to recursively query hardware details */ 49962306a36Sopenharmony_cistatic void vmu_queryblocks(struct mapleq *mq) 50062306a36Sopenharmony_ci{ 50162306a36Sopenharmony_ci struct maple_device *mdev; 50262306a36Sopenharmony_ci unsigned short *res; 50362306a36Sopenharmony_ci struct memcard *card; 50462306a36Sopenharmony_ci __be32 partnum; 50562306a36Sopenharmony_ci struct vmu_cache *pcache; 50662306a36Sopenharmony_ci struct mdev_part *mpart; 50762306a36Sopenharmony_ci struct mtd_info *mtd_cur; 50862306a36Sopenharmony_ci struct vmupart *part_cur; 50962306a36Sopenharmony_ci int error; 51062306a36Sopenharmony_ci 51162306a36Sopenharmony_ci mdev = mq->dev; 51262306a36Sopenharmony_ci card = maple_get_drvdata(mdev); 51362306a36Sopenharmony_ci res = (unsigned short *) (mq->recvbuf->buf); 51462306a36Sopenharmony_ci card->tempA = res[12]; 51562306a36Sopenharmony_ci card->tempB = res[6]; 51662306a36Sopenharmony_ci 51762306a36Sopenharmony_ci dev_info(&mdev->dev, "VMU device at partition %d has %d user " 51862306a36Sopenharmony_ci "blocks with a root block at %d\n", card->partition, 51962306a36Sopenharmony_ci card->tempA, card->tempB); 52062306a36Sopenharmony_ci 52162306a36Sopenharmony_ci part_cur = &card->parts[card->partition]; 52262306a36Sopenharmony_ci part_cur->user_blocks = card->tempA; 52362306a36Sopenharmony_ci part_cur->root_block = card->tempB; 52462306a36Sopenharmony_ci part_cur->numblocks = card->tempB + 1; 52562306a36Sopenharmony_ci part_cur->name = kmalloc(12, GFP_KERNEL); 52662306a36Sopenharmony_ci if (!part_cur->name) 52762306a36Sopenharmony_ci goto fail_name; 52862306a36Sopenharmony_ci 52962306a36Sopenharmony_ci sprintf(part_cur->name, "vmu%d.%d.%d", 53062306a36Sopenharmony_ci mdev->port, mdev->unit, card->partition); 53162306a36Sopenharmony_ci mtd_cur = &card->mtd[card->partition]; 53262306a36Sopenharmony_ci mtd_cur->name = part_cur->name; 53362306a36Sopenharmony_ci mtd_cur->type = 8; 53462306a36Sopenharmony_ci mtd_cur->flags = MTD_WRITEABLE|MTD_NO_ERASE; 53562306a36Sopenharmony_ci mtd_cur->size = part_cur->numblocks * card->blocklen; 53662306a36Sopenharmony_ci mtd_cur->erasesize = card->blocklen; 53762306a36Sopenharmony_ci mtd_cur->_write = vmu_flash_write; 53862306a36Sopenharmony_ci mtd_cur->_read = vmu_flash_read; 53962306a36Sopenharmony_ci mtd_cur->_sync = vmu_flash_sync; 54062306a36Sopenharmony_ci mtd_cur->writesize = card->blocklen; 54162306a36Sopenharmony_ci 54262306a36Sopenharmony_ci mpart = kmalloc(sizeof(struct mdev_part), GFP_KERNEL); 54362306a36Sopenharmony_ci if (!mpart) 54462306a36Sopenharmony_ci goto fail_mpart; 54562306a36Sopenharmony_ci 54662306a36Sopenharmony_ci mpart->mdev = mdev; 54762306a36Sopenharmony_ci mpart->partition = card->partition; 54862306a36Sopenharmony_ci mtd_cur->priv = mpart; 54962306a36Sopenharmony_ci mtd_cur->owner = THIS_MODULE; 55062306a36Sopenharmony_ci 55162306a36Sopenharmony_ci pcache = kzalloc(sizeof(struct vmu_cache), GFP_KERNEL); 55262306a36Sopenharmony_ci if (!pcache) 55362306a36Sopenharmony_ci goto fail_cache_create; 55462306a36Sopenharmony_ci part_cur->pcache = pcache; 55562306a36Sopenharmony_ci 55662306a36Sopenharmony_ci error = mtd_device_register(mtd_cur, NULL, 0); 55762306a36Sopenharmony_ci if (error) 55862306a36Sopenharmony_ci goto fail_mtd_register; 55962306a36Sopenharmony_ci 56062306a36Sopenharmony_ci maple_getcond_callback(mdev, NULL, 0, 56162306a36Sopenharmony_ci MAPLE_FUNC_MEMCARD); 56262306a36Sopenharmony_ci 56362306a36Sopenharmony_ci /* 56462306a36Sopenharmony_ci * Set up a recursive call to the (probably theoretical) 56562306a36Sopenharmony_ci * second or more partition 56662306a36Sopenharmony_ci */ 56762306a36Sopenharmony_ci if (++card->partition < card->partitions) { 56862306a36Sopenharmony_ci partnum = cpu_to_be32(card->partition << 24); 56962306a36Sopenharmony_ci maple_getcond_callback(mdev, vmu_queryblocks, 0, 57062306a36Sopenharmony_ci MAPLE_FUNC_MEMCARD); 57162306a36Sopenharmony_ci maple_add_packet(mdev, MAPLE_FUNC_MEMCARD, 57262306a36Sopenharmony_ci MAPLE_COMMAND_GETMINFO, 2, &partnum); 57362306a36Sopenharmony_ci } 57462306a36Sopenharmony_ci return; 57562306a36Sopenharmony_ci 57662306a36Sopenharmony_cifail_mtd_register: 57762306a36Sopenharmony_ci dev_err(&mdev->dev, "Could not register maple device at (%d, %d)" 57862306a36Sopenharmony_ci "error is 0x%X\n", mdev->port, mdev->unit, error); 57962306a36Sopenharmony_ci for (error = 0; error <= card->partition; error++) { 58062306a36Sopenharmony_ci kfree(((card->parts)[error]).pcache); 58162306a36Sopenharmony_ci ((card->parts)[error]).pcache = NULL; 58262306a36Sopenharmony_ci } 58362306a36Sopenharmony_cifail_cache_create: 58462306a36Sopenharmony_cifail_mpart: 58562306a36Sopenharmony_ci for (error = 0; error <= card->partition; error++) { 58662306a36Sopenharmony_ci kfree(((card->mtd)[error]).priv); 58762306a36Sopenharmony_ci ((card->mtd)[error]).priv = NULL; 58862306a36Sopenharmony_ci } 58962306a36Sopenharmony_ci maple_getcond_callback(mdev, NULL, 0, 59062306a36Sopenharmony_ci MAPLE_FUNC_MEMCARD); 59162306a36Sopenharmony_ci kfree(part_cur->name); 59262306a36Sopenharmony_cifail_name: 59362306a36Sopenharmony_ci return; 59462306a36Sopenharmony_ci} 59562306a36Sopenharmony_ci 59662306a36Sopenharmony_ci/* Handles very basic info about the flash, queries for details */ 59762306a36Sopenharmony_cistatic int vmu_connect(struct maple_device *mdev) 59862306a36Sopenharmony_ci{ 59962306a36Sopenharmony_ci unsigned long test_flash_data, basic_flash_data; 60062306a36Sopenharmony_ci int c, error; 60162306a36Sopenharmony_ci struct memcard *card; 60262306a36Sopenharmony_ci u32 partnum = 0; 60362306a36Sopenharmony_ci 60462306a36Sopenharmony_ci test_flash_data = be32_to_cpu(mdev->devinfo.function); 60562306a36Sopenharmony_ci /* Need to count how many bits are set - to find out which 60662306a36Sopenharmony_ci * function_data element has details of the memory card 60762306a36Sopenharmony_ci */ 60862306a36Sopenharmony_ci c = hweight_long(test_flash_data); 60962306a36Sopenharmony_ci 61062306a36Sopenharmony_ci basic_flash_data = be32_to_cpu(mdev->devinfo.function_data[c - 1]); 61162306a36Sopenharmony_ci 61262306a36Sopenharmony_ci card = kmalloc(sizeof(struct memcard), GFP_KERNEL); 61362306a36Sopenharmony_ci if (!card) { 61462306a36Sopenharmony_ci error = -ENOMEM; 61562306a36Sopenharmony_ci goto fail_nomem; 61662306a36Sopenharmony_ci } 61762306a36Sopenharmony_ci 61862306a36Sopenharmony_ci card->partitions = (basic_flash_data >> 24 & 0xFF) + 1; 61962306a36Sopenharmony_ci card->blocklen = ((basic_flash_data >> 16 & 0xFF) + 1) << 5; 62062306a36Sopenharmony_ci card->writecnt = basic_flash_data >> 12 & 0xF; 62162306a36Sopenharmony_ci card->readcnt = basic_flash_data >> 8 & 0xF; 62262306a36Sopenharmony_ci card->removable = basic_flash_data >> 7 & 1; 62362306a36Sopenharmony_ci 62462306a36Sopenharmony_ci card->partition = 0; 62562306a36Sopenharmony_ci 62662306a36Sopenharmony_ci /* 62762306a36Sopenharmony_ci * Not sure there are actually any multi-partition devices in the 62862306a36Sopenharmony_ci * real world, but the hardware supports them, so, so will we 62962306a36Sopenharmony_ci */ 63062306a36Sopenharmony_ci card->parts = kmalloc_array(card->partitions, sizeof(struct vmupart), 63162306a36Sopenharmony_ci GFP_KERNEL); 63262306a36Sopenharmony_ci if (!card->parts) { 63362306a36Sopenharmony_ci error = -ENOMEM; 63462306a36Sopenharmony_ci goto fail_partitions; 63562306a36Sopenharmony_ci } 63662306a36Sopenharmony_ci 63762306a36Sopenharmony_ci card->mtd = kmalloc_array(card->partitions, sizeof(struct mtd_info), 63862306a36Sopenharmony_ci GFP_KERNEL); 63962306a36Sopenharmony_ci if (!card->mtd) { 64062306a36Sopenharmony_ci error = -ENOMEM; 64162306a36Sopenharmony_ci goto fail_mtd_info; 64262306a36Sopenharmony_ci } 64362306a36Sopenharmony_ci 64462306a36Sopenharmony_ci maple_set_drvdata(mdev, card); 64562306a36Sopenharmony_ci 64662306a36Sopenharmony_ci /* 64762306a36Sopenharmony_ci * We want to trap meminfo not get cond 64862306a36Sopenharmony_ci * so set interval to zero, but rely on maple bus 64962306a36Sopenharmony_ci * driver to pass back the results of the meminfo 65062306a36Sopenharmony_ci */ 65162306a36Sopenharmony_ci maple_getcond_callback(mdev, vmu_queryblocks, 0, 65262306a36Sopenharmony_ci MAPLE_FUNC_MEMCARD); 65362306a36Sopenharmony_ci 65462306a36Sopenharmony_ci /* Make sure we are clear to go */ 65562306a36Sopenharmony_ci if (atomic_read(&mdev->busy) == 1) { 65662306a36Sopenharmony_ci wait_event_interruptible_timeout(mdev->maple_wait, 65762306a36Sopenharmony_ci atomic_read(&mdev->busy) == 0, HZ); 65862306a36Sopenharmony_ci if (atomic_read(&mdev->busy) == 1) { 65962306a36Sopenharmony_ci dev_notice(&mdev->dev, "VMU at (%d, %d) is busy\n", 66062306a36Sopenharmony_ci mdev->port, mdev->unit); 66162306a36Sopenharmony_ci error = -EAGAIN; 66262306a36Sopenharmony_ci goto fail_device_busy; 66362306a36Sopenharmony_ci } 66462306a36Sopenharmony_ci } 66562306a36Sopenharmony_ci 66662306a36Sopenharmony_ci atomic_set(&mdev->busy, 1); 66762306a36Sopenharmony_ci 66862306a36Sopenharmony_ci /* 66962306a36Sopenharmony_ci * Set up the minfo call: vmu_queryblocks will handle 67062306a36Sopenharmony_ci * the information passed back 67162306a36Sopenharmony_ci */ 67262306a36Sopenharmony_ci error = maple_add_packet(mdev, MAPLE_FUNC_MEMCARD, 67362306a36Sopenharmony_ci MAPLE_COMMAND_GETMINFO, 2, &partnum); 67462306a36Sopenharmony_ci if (error) { 67562306a36Sopenharmony_ci dev_err(&mdev->dev, "Could not lock VMU at (%d, %d)" 67662306a36Sopenharmony_ci " error is 0x%X\n", mdev->port, mdev->unit, error); 67762306a36Sopenharmony_ci goto fail_mtd_info; 67862306a36Sopenharmony_ci } 67962306a36Sopenharmony_ci return 0; 68062306a36Sopenharmony_ci 68162306a36Sopenharmony_cifail_device_busy: 68262306a36Sopenharmony_ci kfree(card->mtd); 68362306a36Sopenharmony_cifail_mtd_info: 68462306a36Sopenharmony_ci kfree(card->parts); 68562306a36Sopenharmony_cifail_partitions: 68662306a36Sopenharmony_ci kfree(card); 68762306a36Sopenharmony_cifail_nomem: 68862306a36Sopenharmony_ci return error; 68962306a36Sopenharmony_ci} 69062306a36Sopenharmony_ci 69162306a36Sopenharmony_cistatic void vmu_disconnect(struct maple_device *mdev) 69262306a36Sopenharmony_ci{ 69362306a36Sopenharmony_ci struct memcard *card; 69462306a36Sopenharmony_ci struct mdev_part *mpart; 69562306a36Sopenharmony_ci int x; 69662306a36Sopenharmony_ci 69762306a36Sopenharmony_ci mdev->callback = NULL; 69862306a36Sopenharmony_ci card = maple_get_drvdata(mdev); 69962306a36Sopenharmony_ci for (x = 0; x < card->partitions; x++) { 70062306a36Sopenharmony_ci mpart = ((card->mtd)[x]).priv; 70162306a36Sopenharmony_ci mpart->mdev = NULL; 70262306a36Sopenharmony_ci mtd_device_unregister(&((card->mtd)[x])); 70362306a36Sopenharmony_ci kfree(((card->parts)[x]).name); 70462306a36Sopenharmony_ci } 70562306a36Sopenharmony_ci kfree(card->parts); 70662306a36Sopenharmony_ci kfree(card->mtd); 70762306a36Sopenharmony_ci kfree(card); 70862306a36Sopenharmony_ci} 70962306a36Sopenharmony_ci 71062306a36Sopenharmony_ci/* Callback to handle eccentricities of both mtd subsystem 71162306a36Sopenharmony_ci * and general flakyness of Dreamcast VMUs 71262306a36Sopenharmony_ci */ 71362306a36Sopenharmony_cistatic int vmu_can_unload(struct maple_device *mdev) 71462306a36Sopenharmony_ci{ 71562306a36Sopenharmony_ci struct memcard *card; 71662306a36Sopenharmony_ci int x; 71762306a36Sopenharmony_ci struct mtd_info *mtd; 71862306a36Sopenharmony_ci 71962306a36Sopenharmony_ci card = maple_get_drvdata(mdev); 72062306a36Sopenharmony_ci for (x = 0; x < card->partitions; x++) { 72162306a36Sopenharmony_ci mtd = &((card->mtd)[x]); 72262306a36Sopenharmony_ci if (kref_read(&mtd->refcnt)) 72362306a36Sopenharmony_ci return 0; 72462306a36Sopenharmony_ci } 72562306a36Sopenharmony_ci return 1; 72662306a36Sopenharmony_ci} 72762306a36Sopenharmony_ci 72862306a36Sopenharmony_ci#define ERRSTR "VMU at (%d, %d) file error -" 72962306a36Sopenharmony_ci 73062306a36Sopenharmony_cistatic void vmu_file_error(struct maple_device *mdev, void *recvbuf) 73162306a36Sopenharmony_ci{ 73262306a36Sopenharmony_ci enum maple_file_errors error = ((int *)recvbuf)[1]; 73362306a36Sopenharmony_ci 73462306a36Sopenharmony_ci switch (error) { 73562306a36Sopenharmony_ci 73662306a36Sopenharmony_ci case MAPLE_FILEERR_INVALID_PARTITION: 73762306a36Sopenharmony_ci dev_notice(&mdev->dev, ERRSTR " invalid partition number\n", 73862306a36Sopenharmony_ci mdev->port, mdev->unit); 73962306a36Sopenharmony_ci break; 74062306a36Sopenharmony_ci 74162306a36Sopenharmony_ci case MAPLE_FILEERR_PHASE_ERROR: 74262306a36Sopenharmony_ci dev_notice(&mdev->dev, ERRSTR " phase error\n", 74362306a36Sopenharmony_ci mdev->port, mdev->unit); 74462306a36Sopenharmony_ci break; 74562306a36Sopenharmony_ci 74662306a36Sopenharmony_ci case MAPLE_FILEERR_INVALID_BLOCK: 74762306a36Sopenharmony_ci dev_notice(&mdev->dev, ERRSTR " invalid block number\n", 74862306a36Sopenharmony_ci mdev->port, mdev->unit); 74962306a36Sopenharmony_ci break; 75062306a36Sopenharmony_ci 75162306a36Sopenharmony_ci case MAPLE_FILEERR_WRITE_ERROR: 75262306a36Sopenharmony_ci dev_notice(&mdev->dev, ERRSTR " write error\n", 75362306a36Sopenharmony_ci mdev->port, mdev->unit); 75462306a36Sopenharmony_ci break; 75562306a36Sopenharmony_ci 75662306a36Sopenharmony_ci case MAPLE_FILEERR_INVALID_WRITE_LENGTH: 75762306a36Sopenharmony_ci dev_notice(&mdev->dev, ERRSTR " invalid write length\n", 75862306a36Sopenharmony_ci mdev->port, mdev->unit); 75962306a36Sopenharmony_ci break; 76062306a36Sopenharmony_ci 76162306a36Sopenharmony_ci case MAPLE_FILEERR_BAD_CRC: 76262306a36Sopenharmony_ci dev_notice(&mdev->dev, ERRSTR " bad CRC\n", 76362306a36Sopenharmony_ci mdev->port, mdev->unit); 76462306a36Sopenharmony_ci break; 76562306a36Sopenharmony_ci 76662306a36Sopenharmony_ci default: 76762306a36Sopenharmony_ci dev_notice(&mdev->dev, ERRSTR " 0x%X\n", 76862306a36Sopenharmony_ci mdev->port, mdev->unit, error); 76962306a36Sopenharmony_ci } 77062306a36Sopenharmony_ci} 77162306a36Sopenharmony_ci 77262306a36Sopenharmony_ci 77362306a36Sopenharmony_cistatic int probe_maple_vmu(struct device *dev) 77462306a36Sopenharmony_ci{ 77562306a36Sopenharmony_ci struct maple_device *mdev = to_maple_dev(dev); 77662306a36Sopenharmony_ci struct maple_driver *mdrv = to_maple_driver(dev->driver); 77762306a36Sopenharmony_ci 77862306a36Sopenharmony_ci mdev->can_unload = vmu_can_unload; 77962306a36Sopenharmony_ci mdev->fileerr_handler = vmu_file_error; 78062306a36Sopenharmony_ci mdev->driver = mdrv; 78162306a36Sopenharmony_ci 78262306a36Sopenharmony_ci return vmu_connect(mdev); 78362306a36Sopenharmony_ci} 78462306a36Sopenharmony_ci 78562306a36Sopenharmony_cistatic int remove_maple_vmu(struct device *dev) 78662306a36Sopenharmony_ci{ 78762306a36Sopenharmony_ci struct maple_device *mdev = to_maple_dev(dev); 78862306a36Sopenharmony_ci 78962306a36Sopenharmony_ci vmu_disconnect(mdev); 79062306a36Sopenharmony_ci return 0; 79162306a36Sopenharmony_ci} 79262306a36Sopenharmony_ci 79362306a36Sopenharmony_cistatic struct maple_driver vmu_flash_driver = { 79462306a36Sopenharmony_ci .function = MAPLE_FUNC_MEMCARD, 79562306a36Sopenharmony_ci .drv = { 79662306a36Sopenharmony_ci .name = "Dreamcast_visual_memory", 79762306a36Sopenharmony_ci .probe = probe_maple_vmu, 79862306a36Sopenharmony_ci .remove = remove_maple_vmu, 79962306a36Sopenharmony_ci }, 80062306a36Sopenharmony_ci}; 80162306a36Sopenharmony_ci 80262306a36Sopenharmony_cistatic int __init vmu_flash_map_init(void) 80362306a36Sopenharmony_ci{ 80462306a36Sopenharmony_ci return maple_driver_register(&vmu_flash_driver); 80562306a36Sopenharmony_ci} 80662306a36Sopenharmony_ci 80762306a36Sopenharmony_cistatic void __exit vmu_flash_map_exit(void) 80862306a36Sopenharmony_ci{ 80962306a36Sopenharmony_ci maple_driver_unregister(&vmu_flash_driver); 81062306a36Sopenharmony_ci} 81162306a36Sopenharmony_ci 81262306a36Sopenharmony_cimodule_init(vmu_flash_map_init); 81362306a36Sopenharmony_cimodule_exit(vmu_flash_map_exit); 81462306a36Sopenharmony_ci 81562306a36Sopenharmony_ciMODULE_LICENSE("GPL"); 81662306a36Sopenharmony_ciMODULE_AUTHOR("Adrian McMenamin"); 81762306a36Sopenharmony_ciMODULE_DESCRIPTION("Flash mapping for Sega Dreamcast visual memory"); 818