[deliverable/linux.git] / drivers / char / ps3flash.c

/*
 * PS3 FLASH ROM Storage Driver
 *
 * Copyright (C) 2007 Sony Computer Entertainment Inc.
 * Copyright 2007 Sony Corp.
 *
 * 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; version 2 of the License.
 *
 * 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.,
 * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
 */

#include <linux/fs.h>
#include <linux/miscdevice.h>
#include <linux/slab.h>
#include <linux/uaccess.h>

#include <asm/lv1call.h>
#include <asm/ps3stor.h>


#define DEVICE_NAME		"ps3flash"

#define FLASH_BLOCK_SIZE	(256*1024)


struct ps3flash_private {
	struct mutex mutex;	/* Bounce buffer mutex */
	u64 chunk_sectors;
	int tag;		/* Start sector of buffer, -1 if invalid */
	bool dirty;
};

static struct ps3_storage_device *ps3flash_dev;

static int ps3flash_read_write_sectors(struct ps3_storage_device *dev,
				       u64 start_sector, int write)
{
	struct ps3flash_private *priv = ps3_system_bus_get_drvdata(&dev->sbd);
	u64 res = ps3stor_read_write_sectors(dev, dev->bounce_lpar,
					     start_sector, priv->chunk_sectors,
					     write);
	if (res) {
		dev_err(&dev->sbd.core, "%s:%u: %s failed 0x%llx\n", __func__,
			__LINE__, write ? "write" : "read", res);
		return -EIO;
	}
	return 0;
}

static int ps3flash_writeback(struct ps3_storage_device *dev)
{
	struct ps3flash_private *priv = ps3_system_bus_get_drvdata(&dev->sbd);
	int res;

	if (!priv->dirty || priv->tag < 0)
		return 0;

	res = ps3flash_read_write_sectors(dev, priv->tag, 1);
	if (res)
		return res;

	priv->dirty = false;
	return 0;
}

static int ps3flash_fetch(struct ps3_storage_device *dev, u64 start_sector)
{
	struct ps3flash_private *priv = ps3_system_bus_get_drvdata(&dev->sbd);
	int res;

	if (start_sector == priv->tag)
		return 0;

	res = ps3flash_writeback(dev);
	if (res)
		return res;

	priv->tag = -1;

	res = ps3flash_read_write_sectors(dev, start_sector, 0);
	if (res)
		return res;

	priv->tag = start_sector;
	return 0;
}

static loff_t ps3flash_llseek(struct file *file, loff_t offset, int origin)
{
	struct ps3_storage_device *dev = ps3flash_dev;
	loff_t res;

	mutex_lock(&file->f_mapping->host->i_mutex);
	switch (origin) {
	case 0:
		break;
	case 1:
		offset += file->f_pos;
		break;
	case 2:
		offset += dev->regions[dev->region_idx].size*dev->blk_size;
		break;
	default:
		offset = -1;
	}
	if (offset < 0) {
		res = -EINVAL;
		goto out;
	}

	file->f_pos = offset;
	res = file->f_pos;

out:
	mutex_unlock(&file->f_mapping->host->i_mutex);
	return res;
}

static ssize_t ps3flash_read(char __user *userbuf, void *kernelbuf,
			     size_t count, loff_t *pos)
{
	struct ps3_storage_device *dev = ps3flash_dev;
	struct ps3flash_private *priv = ps3_system_bus_get_drvdata(&dev->sbd);
	u64 size, sector, offset;
	int res;
	size_t remaining, n;
	const void *src;

	dev_dbg(&dev->sbd.core,
		"%s:%u: Reading %zu bytes at position %lld to U0x%p/K0x%p\n",
		__func__, __LINE__, count, *pos, userbuf, kernelbuf);

	size = dev->regions[dev->region_idx].size*dev->blk_size;
	if (*pos >= size || !count)
		return 0;

	if (*pos + count > size) {
		dev_dbg(&dev->sbd.core,
			"%s:%u Truncating count from %zu to %llu\n", __func__,
			__LINE__, count, size - *pos);
		count = size - *pos;
	}

	sector = *pos / dev->bounce_size * priv->chunk_sectors;
	offset = *pos % dev->bounce_size;

	remaining = count;
	do {
		n = min_t(u64, remaining, dev->bounce_size - offset);
		src = dev->bounce_buf + offset;

		mutex_lock(&priv->mutex);

		res = ps3flash_fetch(dev, sector);
		if (res)
			goto fail;

		dev_dbg(&dev->sbd.core,
			"%s:%u: copy %lu bytes from 0x%p to U0x%p/K0x%p\n",
			__func__, __LINE__, n, src, userbuf, kernelbuf);
		if (userbuf) {
			if (copy_to_user(userbuf, src, n)) {
				res = -EFAULT;
				goto fail;
			}
			userbuf += n;
		}
		if (kernelbuf) {
			memcpy(kernelbuf, src, n);
			kernelbuf += n;
		}

		mutex_unlock(&priv->mutex);

		*pos += n;
		remaining -= n;
		sector += priv->chunk_sectors;
		offset = 0;
	} while (remaining > 0);

	return count;

fail:
	mutex_unlock(&priv->mutex);
	return res;
}

static ssize_t ps3flash_write(const char __user *userbuf,
			      const void *kernelbuf, size_t count, loff_t *pos)
{
	struct ps3_storage_device *dev = ps3flash_dev;
	struct ps3flash_private *priv = ps3_system_bus_get_drvdata(&dev->sbd);
	u64 size, sector, offset;
	int res = 0;
	size_t remaining, n;
	void *dst;

	dev_dbg(&dev->sbd.core,
		"%s:%u: Writing %zu bytes at position %lld from U0x%p/K0x%p\n",
		__func__, __LINE__, count, *pos, userbuf, kernelbuf);

	size = dev->regions[dev->region_idx].size*dev->blk_size;
	if (*pos >= size || !count)
		return 0;

	if (*pos + count > size) {
		dev_dbg(&dev->sbd.core,
			"%s:%u Truncating count from %zu to %llu\n", __func__,
			__LINE__, count, size - *pos);
		count = size - *pos;
	}

	sector = *pos / dev->bounce_size * priv->chunk_sectors;
	offset = *pos % dev->bounce_size;

	remaining = count;
	do {
		n = min_t(u64, remaining, dev->bounce_size - offset);
		dst = dev->bounce_buf + offset;

		mutex_lock(&priv->mutex);

		if (n != dev->bounce_size)
			res = ps3flash_fetch(dev, sector);
		else if (sector != priv->tag)
			res = ps3flash_writeback(dev);
		if (res)
			goto fail;

		dev_dbg(&dev->sbd.core,
			"%s:%u: copy %lu bytes from U0x%p/K0x%p to 0x%p\n",
			__func__, __LINE__, n, userbuf, kernelbuf, dst);
		if (userbuf) {
			if (copy_from_user(dst, userbuf, n)) {
				res = -EFAULT;
				goto fail;
			}
			userbuf += n;
		}
		if (kernelbuf) {
			memcpy(dst, kernelbuf, n);
			kernelbuf += n;
		}

		priv->tag = sector;
		priv->dirty = true;

		mutex_unlock(&priv->mutex);

		*pos += n;
		remaining -= n;
		sector += priv->chunk_sectors;
		offset = 0;
	} while (remaining > 0);

	return count;

fail:
	mutex_unlock(&priv->mutex);
	return res;
}

static ssize_t ps3flash_user_read(struct file *file, char __user *buf,
				  size_t count, loff_t *pos)
{
	return ps3flash_read(buf, NULL, count, pos);
}

static ssize_t ps3flash_user_write(struct file *file, const char __user *buf,
				   size_t count, loff_t *pos)
{
	return ps3flash_write(buf, NULL, count, pos);
}

static ssize_t ps3flash_kernel_read(void *buf, size_t count, loff_t pos)
{
	return ps3flash_read(NULL, buf, count, &pos);
}

static ssize_t ps3flash_kernel_write(const void *buf, size_t count,
				     loff_t pos)
{
	ssize_t res;
	int wb;

	res = ps3flash_write(NULL, buf, count, &pos);
	if (res < 0)
		return res;

	/* Make kernel writes synchronous */
	wb = ps3flash_writeback(ps3flash_dev);
	if (wb)
		return wb;

	return res;
}

static int ps3flash_flush(struct file *file, fl_owner_t id)
{
	return ps3flash_writeback(ps3flash_dev);
}

static int ps3flash_fsync(struct file *file, loff_t start, loff_t end, int datasync)
{
	struct inode *inode = file->f_path.dentry->d_inode;
	int err;
	mutex_lock(&inode->i_mutex);
	err = ps3flash_writeback(ps3flash_dev);
	mutex_unlock(&inode->i_mutex);
	return err;
}

static irqreturn_t ps3flash_interrupt(int irq, void *data)
{
	struct ps3_storage_device *dev = data;
	int res;
	u64 tag, status;

	res = lv1_storage_get_async_status(dev->sbd.dev_id, &tag, &status);

	if (tag != dev->tag)
		dev_err(&dev->sbd.core,
			"%s:%u: tag mismatch, got %llx, expected %llx\n",
			__func__, __LINE__, tag, dev->tag);

	if (res) {
		dev_err(&dev->sbd.core, "%s:%u: res=%d status=0x%llx\n",
			__func__, __LINE__, res, status);
	} else {
		dev->lv1_status = status;
		complete(&dev->done);
	}
	return IRQ_HANDLED;
}

static const struct file_operations ps3flash_fops = {
	.owner	= THIS_MODULE,
	.llseek	= ps3flash_llseek,
	.read	= ps3flash_user_read,
	.write	= ps3flash_user_write,
	.flush	= ps3flash_flush,
	.fsync	= ps3flash_fsync,
};

static const struct ps3_os_area_flash_ops ps3flash_kernel_ops = {
	.read	= ps3flash_kernel_read,
	.write	= ps3flash_kernel_write,
};

static struct miscdevice ps3flash_misc = {
	.minor	= MISC_DYNAMIC_MINOR,
	.name	= DEVICE_NAME,
	.fops	= &ps3flash_fops,
};

static int __devinit ps3flash_probe(struct ps3_system_bus_device *_dev)
{
	struct ps3_storage_device *dev = to_ps3_storage_device(&_dev->core);
	struct ps3flash_private *priv;
	int error;
	unsigned long tmp;

	tmp = dev->regions[dev->region_idx].start*dev->blk_size;
	if (tmp % FLASH_BLOCK_SIZE) {
		dev_err(&dev->sbd.core,
			"%s:%u region start %lu is not aligned\n", __func__,
			__LINE__, tmp);
		return -EINVAL;
	}
	tmp = dev->regions[dev->region_idx].size*dev->blk_size;
	if (tmp % FLASH_BLOCK_SIZE) {
		dev_err(&dev->sbd.core,
			"%s:%u region size %lu is not aligned\n", __func__,
			__LINE__, tmp);
		return -EINVAL;
	}

	/* use static buffer, kmalloc cannot allocate 256 KiB */
	if (!ps3flash_bounce_buffer.address)
		return -ENODEV;

	if (ps3flash_dev) {
		dev_err(&dev->sbd.core,
			"Only one FLASH device is supported\n");
		return -EBUSY;
	}

	ps3flash_dev = dev;

	priv = kzalloc(sizeof(*priv), GFP_KERNEL);
	if (!priv) {
		error = -ENOMEM;
		goto fail;
	}

	ps3_system_bus_set_drvdata(&dev->sbd, priv);
	mutex_init(&priv->mutex);
	priv->tag = -1;

	dev->bounce_size = ps3flash_bounce_buffer.size;
	dev->bounce_buf = ps3flash_bounce_buffer.address;
	priv->chunk_sectors = dev->bounce_size / dev->blk_size;

	error = ps3stor_setup(dev, ps3flash_interrupt);
	if (error)
		goto fail_free_priv;

	ps3flash_misc.parent = &dev->sbd.core;
	error = misc_register(&ps3flash_misc);
	if (error) {
		dev_err(&dev->sbd.core, "%s:%u: misc_register failed %d\n",
			__func__, __LINE__, error);
		goto fail_teardown;
	}

	dev_info(&dev->sbd.core, "%s:%u: registered misc device %d\n",
		 __func__, __LINE__, ps3flash_misc.minor);

	ps3_os_area_flash_register(&ps3flash_kernel_ops);
	return 0;

fail_teardown:
	ps3stor_teardown(dev);
fail_free_priv:
	kfree(priv);
	ps3_system_bus_set_drvdata(&dev->sbd, NULL);
fail:
	ps3flash_dev = NULL;
	return error;
}

static int ps3flash_remove(struct ps3_system_bus_device *_dev)
{
	struct ps3_storage_device *dev = to_ps3_storage_device(&_dev->core);

	ps3_os_area_flash_register(NULL);
	misc_deregister(&ps3flash_misc);
	ps3stor_teardown(dev);
	kfree(ps3_system_bus_get_drvdata(&dev->sbd));
	ps3_system_bus_set_drvdata(&dev->sbd, NULL);
	ps3flash_dev = NULL;
	return 0;
}


static struct ps3_system_bus_driver ps3flash = {
	.match_id	= PS3_MATCH_ID_STOR_FLASH,
	.core.name	= DEVICE_NAME,
	.core.owner	= THIS_MODULE,
	.probe		= ps3flash_probe,
	.remove		= ps3flash_remove,
	.shutdown	= ps3flash_remove,
};


static int __init ps3flash_init(void)
{
	return ps3_system_bus_driver_register(&ps3flash);
}

static void __exit ps3flash_exit(void)
{
	ps3_system_bus_driver_unregister(&ps3flash);
}

module_init(ps3flash_init);
module_exit(ps3flash_exit);

MODULE_LICENSE("GPL");
MODULE_DESCRIPTION("PS3 FLASH ROM Storage Driver");
MODULE_AUTHOR("Sony Corporation");
MODULE_ALIAS(PS3_MODULE_ALIAS_STOR_FLASH);
Commit	Line	Data
f9652635 GU	1	/*
	2	* PS3 FLASH ROM Storage Driver
	3	*
	4	* Copyright (C) 2007 Sony Computer Entertainment Inc.
	5	* Copyright 2007 Sony Corp.
	6	*
	7	* This program is free software; you can redistribute it and/or modify it
	8	* under the terms of the GNU General Public License as published
	9	* by the Free Software Foundation; version 2 of the License.
	10	*
	11	* This program is distributed in the hope that it will be useful, but
	12	* WITHOUT ANY WARRANTY; without even the implied warranty of
	13	* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
	14	* General Public License for more details.
	15	*
	16	* You should have received a copy of the GNU General Public License along
	17	* with this program; if not, write to the Free Software Foundation, Inc.,
	18	* 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
	19	*/
	20
	21	#include <linux/fs.h>
	22	#include <linux/miscdevice.h>
5a0e3ad6	23	#include <linux/slab.h>
f9652635 GU	24	#include <linux/uaccess.h>
	25
	26	#include <asm/lv1call.h>
	27	#include <asm/ps3stor.h>
	28
	29
	30	#define DEVICE_NAME "ps3flash"
	31
	32	#define FLASH_BLOCK_SIZE (256*1024)
	33
	34
	35	struct ps3flash_private {
	36	struct mutex mutex; /* Bounce buffer mutex */
6bd57f2e GU	37	u64 chunk_sectors;
	38	int tag; /* Start sector of buffer, -1 if invalid */
	39	bool dirty;
f9652635 GU	40	};
	41
	42	static struct ps3_storage_device *ps3flash_dev;
	43
6bd57f2e	44	static int ps3flash_read_write_sectors(struct ps3_storage_device *dev,
42e27bfc	45	u64 start_sector, int write)
f9652635	46	{
42e27bfc GU	47	struct ps3flash_private *priv = ps3_system_bus_get_drvdata(&dev->sbd);
	48	u64 res = ps3stor_read_write_sectors(dev, dev->bounce_lpar,
	49	start_sector, priv->chunk_sectors,
f9652635 GU	50	write);
f9652635 GU	51	if (res) {
4c33d2dc	52	dev_err(&dev->sbd.core, "%s:%u: %s failed 0x%llx\n", __func__,
f9652635 GU	53	__LINE__, write ? "write" : "read", res);
	54	return -EIO;
	55	}
6bd57f2e	56	return 0;
f9652635 GU	57	}
f9652635 GU	58
6bd57f2e	59	static int ps3flash_writeback(struct ps3_storage_device *dev)
f9652635	60	{
6bd57f2e GU	61	struct ps3flash_private *priv = ps3_system_bus_get_drvdata(&dev->sbd);
6bd57f2e GU	62	int res;
f9652635	63
6bd57f2e GU	64	if (!priv->dirty \|\| priv->tag < 0)
	65	return 0;
	66
42e27bfc	67	res = ps3flash_read_write_sectors(dev, priv->tag, 1);
6bd57f2e GU	68	if (res)
6bd57f2e GU	69	return res;
f9652635	70
6bd57f2e GU	71	priv->dirty = false;
6bd57f2e GU	72	return 0;
f9652635 GU	73	}
f9652635 GU	74
42e27bfc	75	static int ps3flash_fetch(struct ps3_storage_device *dev, u64 start_sector)
f9652635	76	{
6bd57f2e	77	struct ps3flash_private *priv = ps3_system_bus_get_drvdata(&dev->sbd);
6bd57f2e GU	78	int res;
6bd57f2e GU	79
42e27bfc	80	if (start_sector == priv->tag)
6bd57f2e GU	81	return 0;
	82
	83	res = ps3flash_writeback(dev);
	84	if (res)
	85	return res;
	86
	87	priv->tag = -1;
	88
42e27bfc	89	res = ps3flash_read_write_sectors(dev, start_sector, 0);
6bd57f2e GU	90	if (res)
	91	return res;
	92
42e27bfc	93	priv->tag = start_sector;
6bd57f2e	94	return 0;
f9652635 GU	95	}
	96
	97	static loff_t ps3flash_llseek(struct file *file, loff_t offset, int origin)
	98	{
	99	struct ps3_storage_device *dev = ps3flash_dev;
	100	loff_t res;
	101
	102	mutex_lock(&file->f_mapping->host->i_mutex);
	103	switch (origin) {
22735068 JB	104	case 0:
22735068 JB	105	break;
f9652635 GU	106	case 1:
	107	offset += file->f_pos;
	108	break;
	109	case 2:
	110	offset += dev->regions[dev->region_idx].size*dev->blk_size;
	111	break;
22735068 JB	112	default:
22735068 JB	113	offset = -1;
f9652635 GU	114	}
	115	if (offset < 0) {
	116	res = -EINVAL;
	117	goto out;
	118	}
	119
	120	file->f_pos = offset;
	121	res = file->f_pos;
	122
	123	out:
	124	mutex_unlock(&file->f_mapping->host->i_mutex);
	125	return res;
	126	}
	127
a4e623fb GU	128	static ssize_t ps3flash_read(char __user userbuf, void kernelbuf,
a4e623fb GU	129	size_t count, loff_t *pos)
f9652635 GU	130	{
f9652635 GU	131	struct ps3_storage_device *dev = ps3flash_dev;
559dc87f	132	struct ps3flash_private *priv = ps3_system_bus_get_drvdata(&dev->sbd);
42e27bfc	133	u64 size, sector, offset;
6bd57f2e	134	int res;
f9652635	135	size_t remaining, n;
a4e623fb	136	const void *src;
f9652635 GU	137
f9652635 GU	138	dev_dbg(&dev->sbd.core,
a4e623fb GU	139	"%s:%u: Reading %zu bytes at position %lld to U0x%p/K0x%p\n",
a4e623fb GU	140	__func__, __LINE__, count, *pos, userbuf, kernelbuf);
f9652635 GU	141
	142	size = dev->regions[dev->region_idx].size*dev->blk_size;
	143	if (*pos >= size \|\| !count)
	144	return 0;
	145
	146	if (*pos + count > size) {
	147	dev_dbg(&dev->sbd.core,
	148	"%s:%u Truncating count from %zu to %llu\n", __func__,
	149	__LINE__, count, size - *pos);
	150	count = size - *pos;
	151	}
	152
42e27bfc	153	sector = pos / dev->bounce_size priv->chunk_sectors;
6bd57f2e	154	offset = *pos % dev->bounce_size;
f9652635 GU	155
	156	remaining = count;
	157	do {
42e27bfc GU	158	n = min_t(u64, remaining, dev->bounce_size - offset);
42e27bfc GU	159	src = dev->bounce_buf + offset;
6bd57f2e	160
f9652635 GU	161	mutex_lock(&priv->mutex);
f9652635 GU	162
42e27bfc	163	res = ps3flash_fetch(dev, sector);
6bd57f2e	164	if (res)
f9652635	165	goto fail;
f9652635	166
f9652635	167	dev_dbg(&dev->sbd.core,
a4e623fb GU	168	"%s:%u: copy %lu bytes from 0x%p to U0x%p/K0x%p\n",
	169	__func__, __LINE__, n, src, userbuf, kernelbuf);
	170	if (userbuf) {
	171	if (copy_to_user(userbuf, src, n)) {
6bd57f2e	172	res = -EFAULT;
a4e623fb GU	173	goto fail;
	174	}
	175	userbuf += n;
	176	}
	177	if (kernelbuf) {
	178	memcpy(kernelbuf, src, n);
	179	kernelbuf += n;
f9652635 GU	180	}
	181
	182	mutex_unlock(&priv->mutex);
	183
	184	*pos += n;
f9652635	185	remaining -= n;
42e27bfc	186	sector += priv->chunk_sectors;
f9652635 GU	187	offset = 0;
	188	} while (remaining > 0);
	189
	190	return count;
	191
	192	fail:
6bd57f2e GU	193	mutex_unlock(&priv->mutex);
6bd57f2e GU	194	return res;
f9652635 GU	195	}
f9652635 GU	196
a4e623fb GU	197	static ssize_t ps3flash_write(const char __user *userbuf,
a4e623fb GU	198	const void kernelbuf, size_t count, loff_t pos)
f9652635 GU	199	{
f9652635 GU	200	struct ps3_storage_device *dev = ps3flash_dev;
559dc87f	201	struct ps3flash_private *priv = ps3_system_bus_get_drvdata(&dev->sbd);
6bd57f2e GU	202	u64 size, sector, offset;
6bd57f2e GU	203	int res = 0;
f9652635	204	size_t remaining, n;
a4e623fb	205	void *dst;
f9652635 GU	206
f9652635 GU	207	dev_dbg(&dev->sbd.core,
a4e623fb GU	208	"%s:%u: Writing %zu bytes at position %lld from U0x%p/K0x%p\n",
a4e623fb GU	209	__func__, __LINE__, count, *pos, userbuf, kernelbuf);
f9652635 GU	210
	211	size = dev->regions[dev->region_idx].size*dev->blk_size;
	212	if (*pos >= size \|\| !count)
	213	return 0;
	214
	215	if (*pos + count > size) {
	216	dev_dbg(&dev->sbd.core,
	217	"%s:%u Truncating count from %zu to %llu\n", __func__,
	218	__LINE__, count, size - *pos);
	219	count = size - *pos;
	220	}
	221
6bd57f2e	222	sector = pos / dev->bounce_size priv->chunk_sectors;
f9652635	223	offset = *pos % dev->bounce_size;
f9652635 GU	224
	225	remaining = count;
	226	do {
6bd57f2e	227	n = min_t(u64, remaining, dev->bounce_size - offset);
42e27bfc	228	dst = dev->bounce_buf + offset;
6bd57f2e	229
f9652635 GU	230	mutex_lock(&priv->mutex);
f9652635 GU	231
6bd57f2e	232	if (n != dev->bounce_size)
42e27bfc	233	res = ps3flash_fetch(dev, sector);
6bd57f2e GU	234	else if (sector != priv->tag)
	235	res = ps3flash_writeback(dev);
	236	if (res)
	237	goto fail;
f9652635	238
f9652635	239	dev_dbg(&dev->sbd.core,
a4e623fb GU	240	"%s:%u: copy %lu bytes from U0x%p/K0x%p to 0x%p\n",
	241	__func__, __LINE__, n, userbuf, kernelbuf, dst);
	242	if (userbuf) {
	243	if (copy_from_user(dst, userbuf, n)) {
	244	res = -EFAULT;
	245	goto fail;
	246	}
	247	userbuf += n;
	248	}
	249	if (kernelbuf) {
	250	memcpy(dst, kernelbuf, n);
	251	kernelbuf += n;
f9652635 GU	252	}
f9652635 GU	253
6bd57f2e GU	254	priv->tag = sector;
6bd57f2e GU	255	priv->dirty = true;
f9652635 GU	256
	257	mutex_unlock(&priv->mutex);
	258
	259	*pos += n;
f9652635	260	remaining -= n;
6bd57f2e	261	sector += priv->chunk_sectors;
f9652635 GU	262	offset = 0;
	263	} while (remaining > 0);
	264
	265	return count;
	266
	267	fail:
	268	mutex_unlock(&priv->mutex);
	269	return res;
	270	}
	271
a4e623fb GU	272	static ssize_t ps3flash_user_read(struct file file, char __user buf,
	273	size_t count, loff_t *pos)
	274	{
	275	return ps3flash_read(buf, NULL, count, pos);
	276	}
	277
	278	static ssize_t ps3flash_user_write(struct file file, const char __user buf,
	279	size_t count, loff_t *pos)
	280	{
	281	return ps3flash_write(buf, NULL, count, pos);
	282	}
	283
	284	static ssize_t ps3flash_kernel_read(void *buf, size_t count, loff_t pos)
	285	{
	286	return ps3flash_read(NULL, buf, count, &pos);
	287	}
	288
	289	static ssize_t ps3flash_kernel_write(const void *buf, size_t count,
	290	loff_t pos)
	291	{
6bd57f2e GU	292	ssize_t res;
	293	int wb;
	294
	295	res = ps3flash_write(NULL, buf, count, &pos);
	296	if (res < 0)
	297	return res;
	298
	299	/* Make kernel writes synchronous */
	300	wb = ps3flash_writeback(ps3flash_dev);
	301	if (wb)
	302	return wb;
	303
	304	return res;
a4e623fb GU	305	}
a4e623fb GU	306
6bd57f2e GU	307	static int ps3flash_flush(struct file *file, fl_owner_t id)
	308	{
	309	return ps3flash_writeback(ps3flash_dev);
	310	}
	311
02c24a82	312	static int ps3flash_fsync(struct file *file, loff_t start, loff_t end, int datasync)
6bd57f2e	313	{
02c24a82 JB	314	struct inode *inode = file->f_path.dentry->d_inode;
	315	int err;
	316	mutex_lock(&inode->i_mutex);
	317	err = ps3flash_writeback(ps3flash_dev);
	318	mutex_unlock(&inode->i_mutex);
	319	return err;
6bd57f2e	320	}
f9652635 GU	321
	322	static irqreturn_t ps3flash_interrupt(int irq, void *data)
	323	{
	324	struct ps3_storage_device *dev = data;
	325	int res;
	326	u64 tag, status;
	327
	328	res = lv1_storage_get_async_status(dev->sbd.dev_id, &tag, &status);
	329
	330	if (tag != dev->tag)
	331	dev_err(&dev->sbd.core,
4c33d2dc	332	"%s:%u: tag mismatch, got %llx, expected %llx\n",
f9652635 GU	333	__func__, __LINE__, tag, dev->tag);
	334
	335	if (res) {
4c33d2dc	336	dev_err(&dev->sbd.core, "%s:%u: res=%d status=0x%llx\n",
f9652635 GU	337	__func__, __LINE__, res, status);
	338	} else {
	339	dev->lv1_status = status;
	340	complete(&dev->done);
	341	}
	342	return IRQ_HANDLED;
	343	}
	344
f9652635 GU	345	static const struct file_operations ps3flash_fops = {
	346	.owner = THIS_MODULE,
	347	.llseek = ps3flash_llseek,
a4e623fb GU	348	.read = ps3flash_user_read,
a4e623fb GU	349	.write = ps3flash_user_write,
6bd57f2e GU	350	.flush = ps3flash_flush,
6bd57f2e GU	351	.fsync = ps3flash_fsync,
a4e623fb GU	352	};
	353
	354	static const struct ps3_os_area_flash_ops ps3flash_kernel_ops = {
	355	.read = ps3flash_kernel_read,
	356	.write = ps3flash_kernel_write,
f9652635 GU	357	};
	358
	359	static struct miscdevice ps3flash_misc = {
	360	.minor = MISC_DYNAMIC_MINOR,
	361	.name = DEVICE_NAME,
	362	.fops = &ps3flash_fops,
	363	};
	364
	365	static int __devinit ps3flash_probe(struct ps3_system_bus_device *_dev)
	366	{
	367	struct ps3_storage_device *dev = to_ps3_storage_device(&_dev->core);
	368	struct ps3flash_private *priv;
	369	int error;
	370	unsigned long tmp;
	371
	372	tmp = dev->regions[dev->region_idx].start*dev->blk_size;
	373	if (tmp % FLASH_BLOCK_SIZE) {
	374	dev_err(&dev->sbd.core,
	375	"%s:%u region start %lu is not aligned\n", __func__,
	376	__LINE__, tmp);
	377	return -EINVAL;
	378	}
	379	tmp = dev->regions[dev->region_idx].size*dev->blk_size;
	380	if (tmp % FLASH_BLOCK_SIZE) {
	381	dev_err(&dev->sbd.core,
	382	"%s:%u region size %lu is not aligned\n", __func__,
	383	__LINE__, tmp);
	384	return -EINVAL;
	385	}
	386
	387	/* use static buffer, kmalloc cannot allocate 256 KiB */
	388	if (!ps3flash_bounce_buffer.address)
	389	return -ENODEV;
	390
	391	if (ps3flash_dev) {
	392	dev_err(&dev->sbd.core,
	393	"Only one FLASH device is supported\n");
	394	return -EBUSY;
	395	}
	396
	397	ps3flash_dev = dev;
	398
	399	priv = kzalloc(sizeof(*priv), GFP_KERNEL);
	400	if (!priv) {
	401	error = -ENOMEM;
	402	goto fail;
	403	}
	404
559dc87f	405	ps3_system_bus_set_drvdata(&dev->sbd, priv);
f9652635	406	mutex_init(&priv->mutex);
6bd57f2e	407	priv->tag = -1;
f9652635 GU	408
	409	dev->bounce_size = ps3flash_bounce_buffer.size;
	410	dev->bounce_buf = ps3flash_bounce_buffer.address;
6bd57f2e	411	priv->chunk_sectors = dev->bounce_size / dev->blk_size;
f9652635 GU	412
	413	error = ps3stor_setup(dev, ps3flash_interrupt);
	414	if (error)
	415	goto fail_free_priv;
	416
	417	ps3flash_misc.parent = &dev->sbd.core;
	418	error = misc_register(&ps3flash_misc);
	419	if (error) {
	420	dev_err(&dev->sbd.core, "%s:%u: misc_register failed %d\n",
	421	__func__, __LINE__, error);
	422	goto fail_teardown;
	423	}
	424
	425	dev_info(&dev->sbd.core, "%s:%u: registered misc device %d\n",
	426	__func__, __LINE__, ps3flash_misc.minor);
a4e623fb GU	427
a4e623fb GU	428	ps3_os_area_flash_register(&ps3flash_kernel_ops);
f9652635 GU	429	return 0;
	430
	431	fail_teardown:
	432	ps3stor_teardown(dev);
	433	fail_free_priv:
	434	kfree(priv);
559dc87f	435	ps3_system_bus_set_drvdata(&dev->sbd, NULL);
f9652635 GU	436	fail:
	437	ps3flash_dev = NULL;
	438	return error;
	439	}
	440
	441	static int ps3flash_remove(struct ps3_system_bus_device *_dev)
	442	{
	443	struct ps3_storage_device *dev = to_ps3_storage_device(&_dev->core);
	444
a4e623fb	445	ps3_os_area_flash_register(NULL);
f9652635 GU	446	misc_deregister(&ps3flash_misc);
f9652635 GU	447	ps3stor_teardown(dev);
559dc87f GU	448	kfree(ps3_system_bus_get_drvdata(&dev->sbd));
559dc87f GU	449	ps3_system_bus_set_drvdata(&dev->sbd, NULL);
f9652635 GU	450	ps3flash_dev = NULL;
	451	return 0;
	452	}
	453
	454
	455	static struct ps3_system_bus_driver ps3flash = {
	456	.match_id = PS3_MATCH_ID_STOR_FLASH,
	457	.core.name = DEVICE_NAME,
	458	.core.owner = THIS_MODULE,
	459	.probe = ps3flash_probe,
	460	.remove = ps3flash_remove,
	461	.shutdown = ps3flash_remove,
	462	};
	463
	464
	465	static int __init ps3flash_init(void)
	466	{
	467	return ps3_system_bus_driver_register(&ps3flash);
	468	}
	469
	470	static void __exit ps3flash_exit(void)
	471	{
	472	ps3_system_bus_driver_unregister(&ps3flash);
	473	}
	474
	475	module_init(ps3flash_init);
	476	module_exit(ps3flash_exit);
	477
	478	MODULE_LICENSE("GPL");
	479	MODULE_DESCRIPTION("PS3 FLASH ROM Storage Driver");
	480	MODULE_AUTHOR("Sony Corporation");
	481	MODULE_ALIAS(PS3_MODULE_ALIAS_STOR_FLASH);