[deliverable/linux.git] / drivers / w1 / ds_w1_bridge.c

/*
 *	ds_w1_bridge.c
 *
 * Copyright (c) 2004 Evgeniy Polyakov <johnpol@2ka.mipt.ru>
 *
 *
 * 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 <linux/module.h>
#include <linux/types.h>

#include "../w1/w1.h"
#include "../w1/w1_int.h"
#include "dscore.h"

static struct ds_device *ds_dev;
static struct w1_bus_master *ds_bus_master;

static u8 ds9490r_touch_bit(void *data, u8 bit)
{
	u8 ret;
	struct ds_device *dev = data;

	if (ds_touch_bit(dev, bit, &ret))
		return 0;

	return ret;
}

static void ds9490r_write_bit(void *data, u8 bit)
{
	struct ds_device *dev = data;

	ds_write_bit(dev, bit);
}

static void ds9490r_write_byte(void *data, u8 byte)
{
	struct ds_device *dev = data;

	ds_write_byte(dev, byte);
}

static u8 ds9490r_read_bit(void *data)
{
	struct ds_device *dev = data;
	int err;
	u8 bit = 0;

	err = ds_touch_bit(dev, 1, &bit);
	if (err)
		return 0;
	//err = ds_read_bit(dev, &bit);
	//if (err)
	//	return 0;

	return bit & 1;
}

static u8 ds9490r_read_byte(void *data)
{
	struct ds_device *dev = data;
	int err;
	u8 byte = 0;

	err = ds_read_byte(dev, &byte);
	if (err)
		return 0;

	return byte;
}

static void ds9490r_write_block(void *data, const u8 *buf, int len)
{
	struct ds_device *dev = data;

	ds_write_block(dev, (u8 *)buf, len);
}

static u8 ds9490r_read_block(void *data, u8 *buf, int len)
{
	struct ds_device *dev = data;
	int err;

	err = ds_read_block(dev, buf, len);
	if (err < 0)
		return 0;

	return len;
}

static u8 ds9490r_reset(void *data)
{
	struct ds_device *dev = data;
	struct ds_status st;
	int err;

	memset(&st, 0, sizeof(st));

	err = ds_reset(dev, &st);
	if (err)
		return 1;

	return 0;
}

static int __devinit ds_w1_init(void)
{
	int err;

	ds_bus_master = kmalloc(sizeof(*ds_bus_master), GFP_KERNEL);
	if (!ds_bus_master) {
		printk(KERN_ERR "Failed to allocate DS9490R USB<->W1 bus_master structure.\n");
		return -ENOMEM;
	}

	ds_dev = ds_get_device();
	if (!ds_dev) {
		printk(KERN_ERR "DS9490R is not registered.\n");
		err =  -ENODEV;
		goto err_out_free_bus_master;
	}

	memset(ds_bus_master, 0, sizeof(*ds_bus_master));

	ds_bus_master->data		= ds_dev;
	ds_bus_master->touch_bit	= &ds9490r_touch_bit;
	ds_bus_master->read_bit		= &ds9490r_read_bit;
	ds_bus_master->write_bit	= &ds9490r_write_bit;
	ds_bus_master->read_byte	= &ds9490r_read_byte;
	ds_bus_master->write_byte	= &ds9490r_write_byte;
	ds_bus_master->read_block	= &ds9490r_read_block;
	ds_bus_master->write_block	= &ds9490r_write_block;
	ds_bus_master->reset_bus	= &ds9490r_reset;

	err = w1_add_master_device(ds_bus_master);
	if (err)
		goto err_out_put_device;

	return 0;

err_out_put_device:
	ds_put_device(ds_dev);
err_out_free_bus_master:
	kfree(ds_bus_master);

	return err;
}

static void __devexit ds_w1_fini(void)
{
	w1_remove_master_device(ds_bus_master);
	ds_put_device(ds_dev);
	kfree(ds_bus_master);
}

module_init(ds_w1_init);
module_exit(ds_w1_fini);

MODULE_LICENSE("GPL");
MODULE_AUTHOR("Evgeniy Polyakov <johnpol@2ka.mipt.ru>");
Commit	Line	Data
1da177e4	1	/*
8949d2aa	2	* ds_w1_bridge.c
1da177e4 LT	3	*
1da177e4 LT	4	* Copyright (c) 2004 Evgeniy Polyakov <johnpol@2ka.mipt.ru>
8949d2aa	5	*
1da177e4 LT	6	*
	7	* This program is free software; you can redistribute it and/or modify
	8	* it under the terms of the GNU General Public License as published by
	9	* the Free Software Foundation; either version 2 of the License, or
	10	* (at your option) any later version.
	11	*
	12	* This program is distributed in the hope that it will be useful,
	13	* but WITHOUT ANY WARRANTY; without even the implied warranty of
	14	* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
	15	* GNU General Public License for more details.
	16	*
	17	* You should have received a copy of the GNU General Public License
	18	* along with this program; if not, write to the Free Software
	19	* Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
	20	*/
	21
	22	#include <linux/module.h>
	23	#include <linux/types.h>
	24
	25	#include "../w1/w1.h"
	26	#include "../w1/w1_int.h"
	27	#include "dscore.h"
8949d2aa	28
1da177e4 LT	29	static struct ds_device *ds_dev;
	30	static struct w1_bus_master *ds_bus_master;
	31
ccd69940	32	static u8 ds9490r_touch_bit(void *data, u8 bit)
1da177e4 LT	33	{
1da177e4 LT	34	u8 ret;
ccd69940	35	struct ds_device *dev = data;
1da177e4 LT	36
	37	if (ds_touch_bit(dev, bit, &ret))
	38	return 0;
	39
	40	return ret;
	41	}
	42
ccd69940	43	static void ds9490r_write_bit(void *data, u8 bit)
1da177e4	44	{
ccd69940	45	struct ds_device *dev = data;
1da177e4 LT	46
	47	ds_write_bit(dev, bit);
	48	}
	49
ccd69940	50	static void ds9490r_write_byte(void *data, u8 byte)
1da177e4	51	{
ccd69940	52	struct ds_device *dev = data;
1da177e4 LT	53
	54	ds_write_byte(dev, byte);
	55	}
	56
ccd69940	57	static u8 ds9490r_read_bit(void *data)
1da177e4	58	{
ccd69940	59	struct ds_device *dev = data;
1da177e4 LT	60	int err;
	61	u8 bit = 0;
	62
	63	err = ds_touch_bit(dev, 1, &bit);
	64	if (err)
	65	return 0;
	66	//err = ds_read_bit(dev, &bit);
	67	//if (err)
	68	// return 0;
	69
	70	return bit & 1;
	71	}
	72
ccd69940	73	static u8 ds9490r_read_byte(void *data)
1da177e4	74	{
ccd69940	75	struct ds_device *dev = data;
1da177e4 LT	76	int err;
	77	u8 byte = 0;
	78
	79	err = ds_read_byte(dev, &byte);
	80	if (err)
	81	return 0;
	82
	83	return byte;
	84	}
	85
ccd69940	86	static void ds9490r_write_block(void data, const u8 buf, int len)
1da177e4	87	{
ccd69940	88	struct ds_device *dev = data;
1da177e4	89
6adf87bd	90	ds_write_block(dev, (u8 *)buf, len);
1da177e4 LT	91	}
1da177e4 LT	92
ccd69940	93	static u8 ds9490r_read_block(void data, u8 buf, int len)
1da177e4	94	{
ccd69940	95	struct ds_device *dev = data;
1da177e4 LT	96	int err;
	97
	98	err = ds_read_block(dev, buf, len);
	99	if (err < 0)
	100	return 0;
	101
	102	return len;
	103	}
	104
ccd69940	105	static u8 ds9490r_reset(void *data)
1da177e4	106	{
ccd69940	107	struct ds_device *dev = data;
1da177e4 LT	108	struct ds_status st;
	109	int err;
	110
	111	memset(&st, 0, sizeof(st));
	112
	113	err = ds_reset(dev, &st);
	114	if (err)
	115	return 1;
	116
	117	return 0;
	118	}
	119
	120	static int __devinit ds_w1_init(void)
	121	{
	122	int err;
8949d2aa	123
1da177e4 LT	124	ds_bus_master = kmalloc(sizeof(*ds_bus_master), GFP_KERNEL);
	125	if (!ds_bus_master) {
	126	printk(KERN_ERR "Failed to allocate DS9490R USB<->W1 bus_master structure.\n");
	127	return -ENOMEM;
	128	}
	129
	130	ds_dev = ds_get_device();
	131	if (!ds_dev) {
	132	printk(KERN_ERR "DS9490R is not registered.\n");
	133	err = -ENODEV;
	134	goto err_out_free_bus_master;
	135	}
	136
	137	memset(ds_bus_master, 0, sizeof(*ds_bus_master));
	138
ccd69940	139	ds_bus_master->data = ds_dev;
8949d2aa EP	140	ds_bus_master->touch_bit = &ds9490r_touch_bit;
	141	ds_bus_master->read_bit = &ds9490r_read_bit;
	142	ds_bus_master->write_bit = &ds9490r_write_bit;
	143	ds_bus_master->read_byte = &ds9490r_read_byte;
	144	ds_bus_master->write_byte = &ds9490r_write_byte;
	145	ds_bus_master->read_block = &ds9490r_read_block;
	146	ds_bus_master->write_block = &ds9490r_write_block;
1da177e4 LT	147	ds_bus_master->reset_bus = &ds9490r_reset;
	148
	149	err = w1_add_master_device(ds_bus_master);
	150	if (err)
	151	goto err_out_put_device;
	152
	153	return 0;
	154
	155	err_out_put_device:
	156	ds_put_device(ds_dev);
	157	err_out_free_bus_master:
	158	kfree(ds_bus_master);
	159
	160	return err;
	161	}
	162
	163	static void __devexit ds_w1_fini(void)
	164	{
	165	w1_remove_master_device(ds_bus_master);
	166	ds_put_device(ds_dev);
	167	kfree(ds_bus_master);
	168	}
	169
	170	module_init(ds_w1_init);
	171	module_exit(ds_w1_fini);
	172
	173	MODULE_LICENSE("GPL");
	174	MODULE_AUTHOR("Evgeniy Polyakov <johnpol@2ka.mipt.ru>");