mirror of
https://github.com/BobTheBlinker/android_kernel_motorola_sm6375.git
synced 2026-10-29 11:11:45 -04:00
Linux-2.6.12-rc2
Initial git repository build. I'm not bothering with the full history, even though we have it. We can create a separate "historical" git archive of that later if we want to, and in the meantime it's about 3.2GB when imported into git - space that would just make the early git days unnecessarily complicated, when we don't have a lot of good infrastructure for it. Let it rip!
This commit is contained in:
Linus Torvalds
commit
1da177e4c3
17291 changed files with 6718755 additions and 0 deletions
57
drivers/w1/Kconfig
Normal file
57
drivers/w1/Kconfig
Normal file
|
|
@ -0,0 +1,57 @@
|
|||
menu "Dallas's 1-wire bus"
|
||||
|
||||
config W1
|
||||
tristate "Dallas's 1-wire support"
|
||||
---help---
|
||||
Dallas's 1-wire bus is usefull to connect slow 1-pin devices
|
||||
such as iButtons and thermal sensors.
|
||||
|
||||
If you want W1 support, you should say Y here.
|
||||
|
||||
This W1 support can also be built as a module. If so, the module
|
||||
will be called wire.ko.
|
||||
|
||||
config W1_MATROX
|
||||
tristate "Matrox G400 transport layer for 1-wire"
|
||||
depends on W1 && PCI
|
||||
help
|
||||
Say Y here if you want to communicate with your 1-wire devices
|
||||
using Matrox's G400 GPIO pins.
|
||||
|
||||
This support is also available as a module. If so, the module
|
||||
will be called matrox_w1.ko.
|
||||
|
||||
config W1_DS9490
|
||||
tristate "DS9490R transport layer driver"
|
||||
depends on W1 && USB
|
||||
help
|
||||
Say Y here if you want to have a driver for DS9490R UWB <-> W1 bridge.
|
||||
|
||||
This support is also available as a module. If so, the module
|
||||
will be called ds9490r.ko.
|
||||
|
||||
config W1_DS9490_BRIDGE
|
||||
tristate "DS9490R USB <-> W1 transport layer for 1-wire"
|
||||
depends on W1_DS9490
|
||||
help
|
||||
Say Y here if you want to communicate with your 1-wire devices
|
||||
using DS9490R USB bridge.
|
||||
|
||||
This support is also available as a module. If so, the module
|
||||
will be called ds_w1_bridge.ko.
|
||||
|
||||
config W1_THERM
|
||||
tristate "Thermal family implementation"
|
||||
depends on W1
|
||||
help
|
||||
Say Y here if you want to connect 1-wire thermal sensors to you
|
||||
wire.
|
||||
|
||||
config W1_SMEM
|
||||
tristate "Simple 64bit memory family implementation"
|
||||
depends on W1
|
||||
help
|
||||
Say Y here if you want to connect 1-wire
|
||||
simple 64bit memory rom(ds2401/ds2411/ds1990*) to you wire.
|
||||
|
||||
endmenu
|
||||
20
drivers/w1/Makefile
Normal file
20
drivers/w1/Makefile
Normal file
|
|
@ -0,0 +1,20 @@
|
|||
#
|
||||
# Makefile for the Dallas's 1-wire bus.
|
||||
#
|
||||
|
||||
ifneq ($(CONFIG_NET), y)
|
||||
EXTRA_CFLAGS += -DNETLINK_DISABLED
|
||||
endif
|
||||
|
||||
obj-$(CONFIG_W1) += wire.o
|
||||
wire-objs := w1.o w1_int.o w1_family.o w1_netlink.o w1_io.o
|
||||
|
||||
obj-$(CONFIG_W1_MATROX) += matrox_w1.o
|
||||
obj-$(CONFIG_W1_THERM) += w1_therm.o
|
||||
obj-$(CONFIG_W1_SMEM) += w1_smem.o
|
||||
|
||||
obj-$(CONFIG_W1_DS9490) += ds9490r.o
|
||||
ds9490r-objs := dscore.o
|
||||
|
||||
obj-$(CONFIG_W1_DS9490_BRIDGE) += ds_w1_bridge.o
|
||||
|
||||
174
drivers/w1/ds_w1_bridge.c
Normal file
174
drivers/w1/ds_w1_bridge.c
Normal file
|
|
@ -0,0 +1,174 @@
|
|||
/*
|
||||
* 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(unsigned long data, u8 bit)
|
||||
{
|
||||
u8 ret;
|
||||
struct ds_device *dev = (struct ds_device *)data;
|
||||
|
||||
if (ds_touch_bit(dev, bit, &ret))
|
||||
return 0;
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
static void ds9490r_write_bit(unsigned long data, u8 bit)
|
||||
{
|
||||
struct ds_device *dev = (struct ds_device *)data;
|
||||
|
||||
ds_write_bit(dev, bit);
|
||||
}
|
||||
|
||||
static void ds9490r_write_byte(unsigned long data, u8 byte)
|
||||
{
|
||||
struct ds_device *dev = (struct ds_device *)data;
|
||||
|
||||
ds_write_byte(dev, byte);
|
||||
}
|
||||
|
||||
static u8 ds9490r_read_bit(unsigned long data)
|
||||
{
|
||||
struct ds_device *dev = (struct ds_device *)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(unsigned long data)
|
||||
{
|
||||
struct ds_device *dev = (struct ds_device *)data;
|
||||
int err;
|
||||
u8 byte = 0;
|
||||
|
||||
err = ds_read_byte(dev, &byte);
|
||||
if (err)
|
||||
return 0;
|
||||
|
||||
return byte;
|
||||
}
|
||||
|
||||
static void ds9490r_write_block(unsigned long data, u8 *buf, int len)
|
||||
{
|
||||
struct ds_device *dev = (struct ds_device *)data;
|
||||
|
||||
ds_write_block(dev, buf, len);
|
||||
}
|
||||
|
||||
static u8 ds9490r_read_block(unsigned long data, u8 *buf, int len)
|
||||
{
|
||||
struct ds_device *dev = (struct ds_device *)data;
|
||||
int err;
|
||||
|
||||
err = ds_read_block(dev, buf, len);
|
||||
if (err < 0)
|
||||
return 0;
|
||||
|
||||
return len;
|
||||
}
|
||||
|
||||
static u8 ds9490r_reset(unsigned long data)
|
||||
{
|
||||
struct ds_device *dev = (struct ds_device *)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 = (unsigned long)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 <[email protected]>");
|
||||
789
drivers/w1/dscore.c
Normal file
789
drivers/w1/dscore.c
Normal file
|
|
@ -0,0 +1,789 @@
|
|||
/*
|
||||
* dscore.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/kernel.h>
|
||||
#include <linux/mod_devicetable.h>
|
||||
#include <linux/usb.h>
|
||||
|
||||
#include "dscore.h"
|
||||
|
||||
static struct usb_device_id ds_id_table [] = {
|
||||
{ USB_DEVICE(0x04fa, 0x2490) },
|
||||
{ },
|
||||
};
|
||||
MODULE_DEVICE_TABLE(usb, ds_id_table);
|
||||
|
||||
int ds_probe(struct usb_interface *, const struct usb_device_id *);
|
||||
void ds_disconnect(struct usb_interface *);
|
||||
|
||||
int ds_touch_bit(struct ds_device *, u8, u8 *);
|
||||
int ds_read_byte(struct ds_device *, u8 *);
|
||||
int ds_read_bit(struct ds_device *, u8 *);
|
||||
int ds_write_byte(struct ds_device *, u8);
|
||||
int ds_write_bit(struct ds_device *, u8);
|
||||
int ds_start_pulse(struct ds_device *, int);
|
||||
int ds_set_speed(struct ds_device *, int);
|
||||
int ds_reset(struct ds_device *, struct ds_status *);
|
||||
int ds_detect(struct ds_device *, struct ds_status *);
|
||||
int ds_stop_pulse(struct ds_device *, int);
|
||||
struct ds_device * ds_get_device(void);
|
||||
void ds_put_device(struct ds_device *);
|
||||
|
||||
static inline void ds_dump_status(unsigned char *, unsigned char *, int);
|
||||
static int ds_send_control(struct ds_device *, u16, u16);
|
||||
static int ds_send_control_mode(struct ds_device *, u16, u16);
|
||||
static int ds_send_control_cmd(struct ds_device *, u16, u16);
|
||||
|
||||
|
||||
static struct usb_driver ds_driver = {
|
||||
.owner = THIS_MODULE,
|
||||
.name = "DS9490R",
|
||||
.probe = ds_probe,
|
||||
.disconnect = ds_disconnect,
|
||||
.id_table = ds_id_table,
|
||||
};
|
||||
|
||||
static struct ds_device *ds_dev;
|
||||
|
||||
struct ds_device * ds_get_device(void)
|
||||
{
|
||||
if (ds_dev)
|
||||
atomic_inc(&ds_dev->refcnt);
|
||||
return ds_dev;
|
||||
}
|
||||
|
||||
void ds_put_device(struct ds_device *dev)
|
||||
{
|
||||
atomic_dec(&dev->refcnt);
|
||||
}
|
||||
|
||||
static int ds_send_control_cmd(struct ds_device *dev, u16 value, u16 index)
|
||||
{
|
||||
int err;
|
||||
|
||||
err = usb_control_msg(dev->udev, usb_sndctrlpipe(dev->udev, dev->ep[EP_CONTROL]),
|
||||
CONTROL_CMD, 0x40, value, index, NULL, 0, 1000);
|
||||
if (err < 0) {
|
||||
printk(KERN_ERR "Failed to send command control message %x.%x: err=%d.\n",
|
||||
value, index, err);
|
||||
return err;
|
||||
}
|
||||
|
||||
return err;
|
||||
}
|
||||
|
||||
static int ds_send_control_mode(struct ds_device *dev, u16 value, u16 index)
|
||||
{
|
||||
int err;
|
||||
|
||||
err = usb_control_msg(dev->udev, usb_sndctrlpipe(dev->udev, dev->ep[EP_CONTROL]),
|
||||
MODE_CMD, 0x40, value, index, NULL, 0, 1000);
|
||||
if (err < 0) {
|
||||
printk(KERN_ERR "Failed to send mode control message %x.%x: err=%d.\n",
|
||||
value, index, err);
|
||||
return err;
|
||||
}
|
||||
|
||||
return err;
|
||||
}
|
||||
|
||||
static int ds_send_control(struct ds_device *dev, u16 value, u16 index)
|
||||
{
|
||||
int err;
|
||||
|
||||
err = usb_control_msg(dev->udev, usb_sndctrlpipe(dev->udev, dev->ep[EP_CONTROL]),
|
||||
COMM_CMD, 0x40, value, index, NULL, 0, 1000);
|
||||
if (err < 0) {
|
||||
printk(KERN_ERR "Failed to send control message %x.%x: err=%d.\n",
|
||||
value, index, err);
|
||||
return err;
|
||||
}
|
||||
|
||||
return err;
|
||||
}
|
||||
|
||||
static inline void ds_dump_status(unsigned char *buf, unsigned char *str, int off)
|
||||
{
|
||||
printk("%45s: %8x\n", str, buf[off]);
|
||||
}
|
||||
|
||||
int ds_recv_status_nodump(struct ds_device *dev, struct ds_status *st, unsigned char *buf, int size)
|
||||
{
|
||||
int count, err;
|
||||
|
||||
memset(st, 0, sizeof(st));
|
||||
|
||||
count = 0;
|
||||
err = usb_bulk_msg(dev->udev, usb_rcvbulkpipe(dev->udev, dev->ep[EP_STATUS]), buf, size, &count, 100);
|
||||
if (err < 0) {
|
||||
printk(KERN_ERR "Failed to read 1-wire data from 0x%x: err=%d.\n", dev->ep[EP_STATUS], err);
|
||||
return err;
|
||||
}
|
||||
|
||||
if (count >= sizeof(*st))
|
||||
memcpy(st, buf, sizeof(*st));
|
||||
|
||||
return count;
|
||||
}
|
||||
|
||||
static int ds_recv_status(struct ds_device *dev, struct ds_status *st)
|
||||
{
|
||||
unsigned char buf[64];
|
||||
int count, err = 0, i;
|
||||
|
||||
memcpy(st, buf, sizeof(*st));
|
||||
|
||||
count = ds_recv_status_nodump(dev, st, buf, sizeof(buf));
|
||||
if (count < 0)
|
||||
return err;
|
||||
|
||||
printk("0x%x: count=%d, status: ", dev->ep[EP_STATUS], count);
|
||||
for (i=0; i<count; ++i)
|
||||
printk("%02x ", buf[i]);
|
||||
printk("\n");
|
||||
|
||||
if (count >= 16) {
|
||||
ds_dump_status(buf, "enable flag", 0);
|
||||
ds_dump_status(buf, "1-wire speed", 1);
|
||||
ds_dump_status(buf, "strong pullup duration", 2);
|
||||
ds_dump_status(buf, "programming pulse duration", 3);
|
||||
ds_dump_status(buf, "pulldown slew rate control", 4);
|
||||
ds_dump_status(buf, "write-1 low time", 5);
|
||||
ds_dump_status(buf, "data sample offset/write-0 recovery time", 6);
|
||||
ds_dump_status(buf, "reserved (test register)", 7);
|
||||
ds_dump_status(buf, "device status flags", 8);
|
||||
ds_dump_status(buf, "communication command byte 1", 9);
|
||||
ds_dump_status(buf, "communication command byte 2", 10);
|
||||
ds_dump_status(buf, "communication command buffer status", 11);
|
||||
ds_dump_status(buf, "1-wire data output buffer status", 12);
|
||||
ds_dump_status(buf, "1-wire data input buffer status", 13);
|
||||
ds_dump_status(buf, "reserved", 14);
|
||||
ds_dump_status(buf, "reserved", 15);
|
||||
}
|
||||
|
||||
memcpy(st, buf, sizeof(*st));
|
||||
|
||||
if (st->status & ST_EPOF) {
|
||||
printk(KERN_INFO "Resetting device after ST_EPOF.\n");
|
||||
err = ds_send_control_cmd(dev, CTL_RESET_DEVICE, 0);
|
||||
if (err)
|
||||
return err;
|
||||
count = ds_recv_status_nodump(dev, st, buf, sizeof(buf));
|
||||
if (count < 0)
|
||||
return err;
|
||||
}
|
||||
#if 0
|
||||
if (st->status & ST_IDLE) {
|
||||
printk(KERN_INFO "Resetting pulse after ST_IDLE.\n");
|
||||
err = ds_start_pulse(dev, PULLUP_PULSE_DURATION);
|
||||
if (err)
|
||||
return err;
|
||||
}
|
||||
#endif
|
||||
|
||||
return err;
|
||||
}
|
||||
|
||||
static int ds_recv_data(struct ds_device *dev, unsigned char *buf, int size)
|
||||
{
|
||||
int count, err;
|
||||
struct ds_status st;
|
||||
|
||||
count = 0;
|
||||
err = usb_bulk_msg(dev->udev, usb_rcvbulkpipe(dev->udev, dev->ep[EP_DATA_IN]),
|
||||
buf, size, &count, 1000);
|
||||
if (err < 0) {
|
||||
printk(KERN_INFO "Clearing ep0x%x.\n", dev->ep[EP_DATA_IN]);
|
||||
usb_clear_halt(dev->udev, usb_rcvbulkpipe(dev->udev, dev->ep[EP_DATA_IN]));
|
||||
ds_recv_status(dev, &st);
|
||||
return err;
|
||||
}
|
||||
|
||||
#if 0
|
||||
{
|
||||
int i;
|
||||
|
||||
printk("%s: count=%d: ", __func__, count);
|
||||
for (i=0; i<count; ++i)
|
||||
printk("%02x ", buf[i]);
|
||||
printk("\n");
|
||||
}
|
||||
#endif
|
||||
return count;
|
||||
}
|
||||
|
||||
static int ds_send_data(struct ds_device *dev, unsigned char *buf, int len)
|
||||
{
|
||||
int count, err;
|
||||
|
||||
count = 0;
|
||||
err = usb_bulk_msg(dev->udev, usb_sndbulkpipe(dev->udev, dev->ep[EP_DATA_OUT]), buf, len, &count, 1000);
|
||||
if (err < 0) {
|
||||
printk(KERN_ERR "Failed to read 1-wire data from 0x02: err=%d.\n", err);
|
||||
return err;
|
||||
}
|
||||
|
||||
return err;
|
||||
}
|
||||
|
||||
int ds_stop_pulse(struct ds_device *dev, int limit)
|
||||
{
|
||||
struct ds_status st;
|
||||
int count = 0, err = 0;
|
||||
u8 buf[0x20];
|
||||
|
||||
do {
|
||||
err = ds_send_control(dev, CTL_HALT_EXE_IDLE, 0);
|
||||
if (err)
|
||||
break;
|
||||
err = ds_send_control(dev, CTL_RESUME_EXE, 0);
|
||||
if (err)
|
||||
break;
|
||||
err = ds_recv_status_nodump(dev, &st, buf, sizeof(buf));
|
||||
if (err)
|
||||
break;
|
||||
|
||||
if ((st.status & ST_SPUA) == 0) {
|
||||
err = ds_send_control_mode(dev, MOD_PULSE_EN, 0);
|
||||
if (err)
|
||||
break;
|
||||
}
|
||||
} while(++count < limit);
|
||||
|
||||
return err;
|
||||
}
|
||||
|
||||
int ds_detect(struct ds_device *dev, struct ds_status *st)
|
||||
{
|
||||
int err;
|
||||
|
||||
err = ds_send_control_cmd(dev, CTL_RESET_DEVICE, 0);
|
||||
if (err)
|
||||
return err;
|
||||
|
||||
err = ds_send_control(dev, COMM_SET_DURATION | COMM_IM, 0);
|
||||
if (err)
|
||||
return err;
|
||||
|
||||
err = ds_send_control(dev, COMM_SET_DURATION | COMM_IM | COMM_TYPE, 0x40);
|
||||
if (err)
|
||||
return err;
|
||||
|
||||
err = ds_send_control_mode(dev, MOD_PULSE_EN, PULSE_PROG);
|
||||
if (err)
|
||||
return err;
|
||||
|
||||
err = ds_recv_status(dev, st);
|
||||
|
||||
return err;
|
||||
}
|
||||
|
||||
int ds_wait_status(struct ds_device *dev, struct ds_status *st)
|
||||
{
|
||||
u8 buf[0x20];
|
||||
int err, count = 0;
|
||||
|
||||
do {
|
||||
err = ds_recv_status_nodump(dev, st, buf, sizeof(buf));
|
||||
#if 0
|
||||
if (err >= 0) {
|
||||
int i;
|
||||
printk("0x%x: count=%d, status: ", dev->ep[EP_STATUS], err);
|
||||
for (i=0; i<err; ++i)
|
||||
printk("%02x ", buf[i]);
|
||||
printk("\n");
|
||||
}
|
||||
#endif
|
||||
} while(!(buf[0x08] & 0x20) && !(err < 0) && ++count < 100);
|
||||
|
||||
|
||||
if (((err > 16) && (buf[0x10] & 0x01)) || count >= 100 || err < 0) {
|
||||
ds_recv_status(dev, st);
|
||||
return -1;
|
||||
}
|
||||
else {
|
||||
return 0;
|
||||
}
|
||||
}
|
||||
|
||||
int ds_reset(struct ds_device *dev, struct ds_status *st)
|
||||
{
|
||||
int err;
|
||||
|
||||
//err = ds_send_control(dev, COMM_1_WIRE_RESET | COMM_F | COMM_IM | COMM_SE, SPEED_FLEXIBLE);
|
||||
err = ds_send_control(dev, 0x43, SPEED_NORMAL);
|
||||
if (err)
|
||||
return err;
|
||||
|
||||
ds_wait_status(dev, st);
|
||||
#if 0
|
||||
if (st->command_buffer_status) {
|
||||
printk(KERN_INFO "Short circuit.\n");
|
||||
return -EIO;
|
||||
}
|
||||
#endif
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
int ds_set_speed(struct ds_device *dev, int speed)
|
||||
{
|
||||
int err;
|
||||
|
||||
if (speed != SPEED_NORMAL && speed != SPEED_FLEXIBLE && speed != SPEED_OVERDRIVE)
|
||||
return -EINVAL;
|
||||
|
||||
if (speed != SPEED_OVERDRIVE)
|
||||
speed = SPEED_FLEXIBLE;
|
||||
|
||||
speed &= 0xff;
|
||||
|
||||
err = ds_send_control_mode(dev, MOD_1WIRE_SPEED, speed);
|
||||
if (err)
|
||||
return err;
|
||||
|
||||
return err;
|
||||
}
|
||||
|
||||
int ds_start_pulse(struct ds_device *dev, int delay)
|
||||
{
|
||||
int err;
|
||||
u8 del = 1 + (u8)(delay >> 4);
|
||||
struct ds_status st;
|
||||
|
||||
#if 0
|
||||
err = ds_stop_pulse(dev, 10);
|
||||
if (err)
|
||||
return err;
|
||||
|
||||
err = ds_send_control_mode(dev, MOD_PULSE_EN, PULSE_SPUE);
|
||||
if (err)
|
||||
return err;
|
||||
#endif
|
||||
err = ds_send_control(dev, COMM_SET_DURATION | COMM_IM, del);
|
||||
if (err)
|
||||
return err;
|
||||
|
||||
err = ds_send_control(dev, COMM_PULSE | COMM_IM | COMM_F, 0);
|
||||
if (err)
|
||||
return err;
|
||||
|
||||
mdelay(delay);
|
||||
|
||||
ds_wait_status(dev, &st);
|
||||
|
||||
return err;
|
||||
}
|
||||
|
||||
int ds_touch_bit(struct ds_device *dev, u8 bit, u8 *tbit)
|
||||
{
|
||||
int err, count;
|
||||
struct ds_status st;
|
||||
u16 value = (COMM_BIT_IO | COMM_IM) | ((bit) ? COMM_D : 0);
|
||||
u16 cmd;
|
||||
|
||||
err = ds_send_control(dev, value, 0);
|
||||
if (err)
|
||||
return err;
|
||||
|
||||
count = 0;
|
||||
do {
|
||||
err = ds_wait_status(dev, &st);
|
||||
if (err)
|
||||
return err;
|
||||
|
||||
cmd = st.command0 | (st.command1 << 8);
|
||||
} while (cmd != value && ++count < 10);
|
||||
|
||||
if (err < 0 || count >= 10) {
|
||||
printk(KERN_ERR "Failed to obtain status.\n");
|
||||
return -EINVAL;
|
||||
}
|
||||
|
||||
err = ds_recv_data(dev, tbit, sizeof(*tbit));
|
||||
if (err < 0)
|
||||
return err;
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
int ds_write_bit(struct ds_device *dev, u8 bit)
|
||||
{
|
||||
int err;
|
||||
struct ds_status st;
|
||||
|
||||
err = ds_send_control(dev, COMM_BIT_IO | COMM_IM | (bit) ? COMM_D : 0, 0);
|
||||
if (err)
|
||||
return err;
|
||||
|
||||
ds_wait_status(dev, &st);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
int ds_write_byte(struct ds_device *dev, u8 byte)
|
||||
{
|
||||
int err;
|
||||
struct ds_status st;
|
||||
u8 rbyte;
|
||||
|
||||
err = ds_send_control(dev, COMM_BYTE_IO | COMM_IM | COMM_SPU, byte);
|
||||
if (err)
|
||||
return err;
|
||||
|
||||
err = ds_wait_status(dev, &st);
|
||||
if (err)
|
||||
return err;
|
||||
|
||||
err = ds_recv_data(dev, &rbyte, sizeof(rbyte));
|
||||
if (err < 0)
|
||||
return err;
|
||||
|
||||
ds_start_pulse(dev, PULLUP_PULSE_DURATION);
|
||||
|
||||
return !(byte == rbyte);
|
||||
}
|
||||
|
||||
int ds_read_bit(struct ds_device *dev, u8 *bit)
|
||||
{
|
||||
int err;
|
||||
|
||||
err = ds_send_control_mode(dev, MOD_PULSE_EN, PULSE_SPUE);
|
||||
if (err)
|
||||
return err;
|
||||
|
||||
err = ds_send_control(dev, COMM_BIT_IO | COMM_IM | COMM_SPU | COMM_D, 0);
|
||||
if (err)
|
||||
return err;
|
||||
|
||||
err = ds_recv_data(dev, bit, sizeof(*bit));
|
||||
if (err < 0)
|
||||
return err;
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
int ds_read_byte(struct ds_device *dev, u8 *byte)
|
||||
{
|
||||
int err;
|
||||
struct ds_status st;
|
||||
|
||||
err = ds_send_control(dev, COMM_BYTE_IO | COMM_IM , 0xff);
|
||||
if (err)
|
||||
return err;
|
||||
|
||||
ds_wait_status(dev, &st);
|
||||
|
||||
err = ds_recv_data(dev, byte, sizeof(*byte));
|
||||
if (err < 0)
|
||||
return err;
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
int ds_read_block(struct ds_device *dev, u8 *buf, int len)
|
||||
{
|
||||
struct ds_status st;
|
||||
int err;
|
||||
|
||||
if (len > 64*1024)
|
||||
return -E2BIG;
|
||||
|
||||
memset(buf, 0xFF, len);
|
||||
|
||||
err = ds_send_data(dev, buf, len);
|
||||
if (err < 0)
|
||||
return err;
|
||||
|
||||
err = ds_send_control(dev, COMM_BLOCK_IO | COMM_IM | COMM_SPU, len);
|
||||
if (err)
|
||||
return err;
|
||||
|
||||
ds_wait_status(dev, &st);
|
||||
|
||||
memset(buf, 0x00, len);
|
||||
err = ds_recv_data(dev, buf, len);
|
||||
|
||||
return err;
|
||||
}
|
||||
|
||||
int ds_write_block(struct ds_device *dev, u8 *buf, int len)
|
||||
{
|
||||
int err;
|
||||
struct ds_status st;
|
||||
|
||||
err = ds_send_data(dev, buf, len);
|
||||
if (err < 0)
|
||||
return err;
|
||||
|
||||
ds_wait_status(dev, &st);
|
||||
|
||||
err = ds_send_control(dev, COMM_BLOCK_IO | COMM_IM | COMM_SPU, len);
|
||||
if (err)
|
||||
return err;
|
||||
|
||||
ds_wait_status(dev, &st);
|
||||
|
||||
err = ds_recv_data(dev, buf, len);
|
||||
if (err < 0)
|
||||
return err;
|
||||
|
||||
ds_start_pulse(dev, PULLUP_PULSE_DURATION);
|
||||
|
||||
return !(err == len);
|
||||
}
|
||||
|
||||
int ds_search(struct ds_device *dev, u64 init, u64 *buf, u8 id_number, int conditional_search)
|
||||
{
|
||||
int err;
|
||||
u16 value, index;
|
||||
struct ds_status st;
|
||||
|
||||
memset(buf, 0, sizeof(buf));
|
||||
|
||||
err = ds_send_data(ds_dev, (unsigned char *)&init, 8);
|
||||
if (err)
|
||||
return err;
|
||||
|
||||
ds_wait_status(ds_dev, &st);
|
||||
|
||||
value = COMM_SEARCH_ACCESS | COMM_IM | COMM_SM | COMM_F | COMM_RTS;
|
||||
index = (conditional_search ? 0xEC : 0xF0) | (id_number << 8);
|
||||
err = ds_send_control(ds_dev, value, index);
|
||||
if (err)
|
||||
return err;
|
||||
|
||||
ds_wait_status(ds_dev, &st);
|
||||
|
||||
err = ds_recv_data(ds_dev, (unsigned char *)buf, 8*id_number);
|
||||
if (err < 0)
|
||||
return err;
|
||||
|
||||
return err/8;
|
||||
}
|
||||
|
||||
int ds_match_access(struct ds_device *dev, u64 init)
|
||||
{
|
||||
int err;
|
||||
struct ds_status st;
|
||||
|
||||
err = ds_send_data(dev, (unsigned char *)&init, sizeof(init));
|
||||
if (err)
|
||||
return err;
|
||||
|
||||
ds_wait_status(dev, &st);
|
||||
|
||||
err = ds_send_control(dev, COMM_MATCH_ACCESS | COMM_IM | COMM_RST, 0x0055);
|
||||
if (err)
|
||||
return err;
|
||||
|
||||
ds_wait_status(dev, &st);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
int ds_set_path(struct ds_device *dev, u64 init)
|
||||
{
|
||||
int err;
|
||||
struct ds_status st;
|
||||
u8 buf[9];
|
||||
|
||||
memcpy(buf, &init, 8);
|
||||
buf[8] = BRANCH_MAIN;
|
||||
|
||||
err = ds_send_data(dev, buf, sizeof(buf));
|
||||
if (err)
|
||||
return err;
|
||||
|
||||
ds_wait_status(dev, &st);
|
||||
|
||||
err = ds_send_control(dev, COMM_SET_PATH | COMM_IM | COMM_RST, 0);
|
||||
if (err)
|
||||
return err;
|
||||
|
||||
ds_wait_status(dev, &st);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
int ds_probe(struct usb_interface *intf, const struct usb_device_id *udev_id)
|
||||
{
|
||||
struct usb_device *udev = interface_to_usbdev(intf);
|
||||
struct usb_endpoint_descriptor *endpoint;
|
||||
struct usb_host_interface *iface_desc;
|
||||
int i, err;
|
||||
|
||||
ds_dev = kmalloc(sizeof(struct ds_device), GFP_KERNEL);
|
||||
if (!ds_dev) {
|
||||
printk(KERN_INFO "Failed to allocate new DS9490R structure.\n");
|
||||
return -ENOMEM;
|
||||
}
|
||||
|
||||
ds_dev->udev = usb_get_dev(udev);
|
||||
usb_set_intfdata(intf, ds_dev);
|
||||
|
||||
err = usb_set_interface(ds_dev->udev, intf->altsetting[0].desc.bInterfaceNumber, 3);
|
||||
if (err) {
|
||||
printk(KERN_ERR "Failed to set alternative setting 3 for %d interface: err=%d.\n",
|
||||
intf->altsetting[0].desc.bInterfaceNumber, err);
|
||||
return err;
|
||||
}
|
||||
|
||||
err = usb_reset_configuration(ds_dev->udev);
|
||||
if (err) {
|
||||
printk(KERN_ERR "Failed to reset configuration: err=%d.\n", err);
|
||||
return err;
|
||||
}
|
||||
|
||||
iface_desc = &intf->altsetting[0];
|
||||
if (iface_desc->desc.bNumEndpoints != NUM_EP-1) {
|
||||
printk(KERN_INFO "Num endpoints=%d. It is not DS9490R.\n", iface_desc->desc.bNumEndpoints);
|
||||
return -ENODEV;
|
||||
}
|
||||
|
||||
atomic_set(&ds_dev->refcnt, 0);
|
||||
memset(ds_dev->ep, 0, sizeof(ds_dev->ep));
|
||||
|
||||
/*
|
||||
* This loop doesn'd show control 0 endpoint,
|
||||
* so we will fill only 1-3 endpoints entry.
|
||||
*/
|
||||
for (i = 0; i < iface_desc->desc.bNumEndpoints; ++i) {
|
||||
endpoint = &iface_desc->endpoint[i].desc;
|
||||
|
||||
ds_dev->ep[i+1] = endpoint->bEndpointAddress;
|
||||
|
||||
printk("%d: addr=%x, size=%d, dir=%s, type=%x\n",
|
||||
i, endpoint->bEndpointAddress, le16_to_cpu(endpoint->wMaxPacketSize),
|
||||
(endpoint->bEndpointAddress & USB_DIR_IN)?"IN":"OUT",
|
||||
endpoint->bmAttributes & USB_ENDPOINT_XFERTYPE_MASK);
|
||||
}
|
||||
|
||||
#if 0
|
||||
{
|
||||
int err, i;
|
||||
u64 buf[3];
|
||||
u64 init=0xb30000002078ee81ull;
|
||||
struct ds_status st;
|
||||
|
||||
ds_reset(ds_dev, &st);
|
||||
err = ds_search(ds_dev, init, buf, 3, 0);
|
||||
if (err < 0)
|
||||
return err;
|
||||
for (i=0; i<err; ++i)
|
||||
printk("%d: %llx\n", i, buf[i]);
|
||||
|
||||
printk("Resetting...\n");
|
||||
ds_reset(ds_dev, &st);
|
||||
printk("Setting path for %llx.\n", init);
|
||||
err = ds_set_path(ds_dev, init);
|
||||
if (err)
|
||||
return err;
|
||||
printk("Calling MATCH_ACCESS.\n");
|
||||
err = ds_match_access(ds_dev, init);
|
||||
if (err)
|
||||
return err;
|
||||
|
||||
printk("Searching the bus...\n");
|
||||
err = ds_search(ds_dev, init, buf, 3, 0);
|
||||
|
||||
printk("ds_search() returned %d\n", err);
|
||||
|
||||
if (err < 0)
|
||||
return err;
|
||||
for (i=0; i<err; ++i)
|
||||
printk("%d: %llx\n", i, buf[i]);
|
||||
|
||||
return 0;
|
||||
}
|
||||
#endif
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
void ds_disconnect(struct usb_interface *intf)
|
||||
{
|
||||
struct ds_device *dev;
|
||||
|
||||
dev = usb_get_intfdata(intf);
|
||||
usb_set_intfdata(intf, NULL);
|
||||
|
||||
while (atomic_read(&dev->refcnt)) {
|
||||
printk(KERN_INFO "Waiting for DS to become free: refcnt=%d.\n",
|
||||
atomic_read(&dev->refcnt));
|
||||
|
||||
if (msleep_interruptible(1000))
|
||||
flush_signals(current);
|
||||
}
|
||||
|
||||
usb_put_dev(dev->udev);
|
||||
kfree(dev);
|
||||
ds_dev = NULL;
|
||||
}
|
||||
|
||||
int ds_init(void)
|
||||
{
|
||||
int err;
|
||||
|
||||
err = usb_register(&ds_driver);
|
||||
if (err) {
|
||||
printk(KERN_INFO "Failed to register DS9490R USB device: err=%d.\n", err);
|
||||
return err;
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
void ds_fini(void)
|
||||
{
|
||||
usb_deregister(&ds_driver);
|
||||
}
|
||||
|
||||
module_init(ds_init);
|
||||
module_exit(ds_fini);
|
||||
|
||||
MODULE_LICENSE("GPL");
|
||||
MODULE_AUTHOR("Evgeniy Polyakov <[email protected]>");
|
||||
|
||||
EXPORT_SYMBOL(ds_touch_bit);
|
||||
EXPORT_SYMBOL(ds_read_byte);
|
||||
EXPORT_SYMBOL(ds_read_bit);
|
||||
EXPORT_SYMBOL(ds_read_block);
|
||||
EXPORT_SYMBOL(ds_write_byte);
|
||||
EXPORT_SYMBOL(ds_write_bit);
|
||||
EXPORT_SYMBOL(ds_write_block);
|
||||
EXPORT_SYMBOL(ds_reset);
|
||||
EXPORT_SYMBOL(ds_get_device);
|
||||
EXPORT_SYMBOL(ds_put_device);
|
||||
|
||||
/*
|
||||
* This functions can be used for EEPROM programming,
|
||||
* when driver will be included into mainline this will
|
||||
* require uncommenting.
|
||||
*/
|
||||
#if 0
|
||||
EXPORT_SYMBOL(ds_start_pulse);
|
||||
EXPORT_SYMBOL(ds_set_speed);
|
||||
EXPORT_SYMBOL(ds_detect);
|
||||
EXPORT_SYMBOL(ds_stop_pulse);
|
||||
EXPORT_SYMBOL(ds_search);
|
||||
#endif
|
||||
170
drivers/w1/dscore.h
Normal file
170
drivers/w1/dscore.h
Normal file
|
|
@ -0,0 +1,170 @@
|
|||
/*
|
||||
* dscore.h
|
||||
*
|
||||
* 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
|
||||
*/
|
||||
|
||||
#ifndef __DSCORE_H
|
||||
#define __DSCORE_H
|
||||
|
||||
#include <linux/usb.h>
|
||||
#include <asm/atomic.h>
|
||||
|
||||
/* COMMAND TYPE CODES */
|
||||
#define CONTROL_CMD 0x00
|
||||
#define COMM_CMD 0x01
|
||||
#define MODE_CMD 0x02
|
||||
|
||||
/* CONTROL COMMAND CODES */
|
||||
#define CTL_RESET_DEVICE 0x0000
|
||||
#define CTL_START_EXE 0x0001
|
||||
#define CTL_RESUME_EXE 0x0002
|
||||
#define CTL_HALT_EXE_IDLE 0x0003
|
||||
#define CTL_HALT_EXE_DONE 0x0004
|
||||
#define CTL_FLUSH_COMM_CMDS 0x0007
|
||||
#define CTL_FLUSH_RCV_BUFFER 0x0008
|
||||
#define CTL_FLUSH_XMT_BUFFER 0x0009
|
||||
#define CTL_GET_COMM_CMDS 0x000A
|
||||
|
||||
/* MODE COMMAND CODES */
|
||||
#define MOD_PULSE_EN 0x0000
|
||||
#define MOD_SPEED_CHANGE_EN 0x0001
|
||||
#define MOD_1WIRE_SPEED 0x0002
|
||||
#define MOD_STRONG_PU_DURATION 0x0003
|
||||
#define MOD_PULLDOWN_SLEWRATE 0x0004
|
||||
#define MOD_PROG_PULSE_DURATION 0x0005
|
||||
#define MOD_WRITE1_LOWTIME 0x0006
|
||||
#define MOD_DSOW0_TREC 0x0007
|
||||
|
||||
/* COMMUNICATION COMMAND CODES */
|
||||
#define COMM_ERROR_ESCAPE 0x0601
|
||||
#define COMM_SET_DURATION 0x0012
|
||||
#define COMM_BIT_IO 0x0020
|
||||
#define COMM_PULSE 0x0030
|
||||
#define COMM_1_WIRE_RESET 0x0042
|
||||
#define COMM_BYTE_IO 0x0052
|
||||
#define COMM_MATCH_ACCESS 0x0064
|
||||
#define COMM_BLOCK_IO 0x0074
|
||||
#define COMM_READ_STRAIGHT 0x0080
|
||||
#define COMM_DO_RELEASE 0x6092
|
||||
#define COMM_SET_PATH 0x00A2
|
||||
#define COMM_WRITE_SRAM_PAGE 0x00B2
|
||||
#define COMM_WRITE_EPROM 0x00C4
|
||||
#define COMM_READ_CRC_PROT_PAGE 0x00D4
|
||||
#define COMM_READ_REDIRECT_PAGE_CRC 0x21E4
|
||||
#define COMM_SEARCH_ACCESS 0x00F4
|
||||
|
||||
/* Communication command bits */
|
||||
#define COMM_TYPE 0x0008
|
||||
#define COMM_SE 0x0008
|
||||
#define COMM_D 0x0008
|
||||
#define COMM_Z 0x0008
|
||||
#define COMM_CH 0x0008
|
||||
#define COMM_SM 0x0008
|
||||
#define COMM_R 0x0008
|
||||
#define COMM_IM 0x0001
|
||||
|
||||
#define COMM_PS 0x4000
|
||||
#define COMM_PST 0x4000
|
||||
#define COMM_CIB 0x4000
|
||||
#define COMM_RTS 0x4000
|
||||
#define COMM_DT 0x2000
|
||||
#define COMM_SPU 0x1000
|
||||
#define COMM_F 0x0800
|
||||
#define COMM_NTP 0x0400
|
||||
#define COMM_ICP 0x0200
|
||||
#define COMM_RST 0x0100
|
||||
|
||||
#define PULSE_PROG 0x01
|
||||
#define PULSE_SPUE 0x02
|
||||
|
||||
#define BRANCH_MAIN 0xCC
|
||||
#define BRANCH_AUX 0x33
|
||||
|
||||
/*
|
||||
* Duration of the strong pull-up pulse in milliseconds.
|
||||
*/
|
||||
#define PULLUP_PULSE_DURATION 750
|
||||
|
||||
/* Status flags */
|
||||
#define ST_SPUA 0x01 /* Strong Pull-up is active */
|
||||
#define ST_PRGA 0x02 /* 12V programming pulse is being generated */
|
||||
#define ST_12VP 0x04 /* external 12V programming voltage is present */
|
||||
#define ST_PMOD 0x08 /* DS2490 powered from USB and external sources */
|
||||
#define ST_HALT 0x10 /* DS2490 is currently halted */
|
||||
#define ST_IDLE 0x20 /* DS2490 is currently idle */
|
||||
#define ST_EPOF 0x80
|
||||
|
||||
#define SPEED_NORMAL 0x00
|
||||
#define SPEED_FLEXIBLE 0x01
|
||||
#define SPEED_OVERDRIVE 0x02
|
||||
|
||||
#define NUM_EP 4
|
||||
#define EP_CONTROL 0
|
||||
#define EP_STATUS 1
|
||||
#define EP_DATA_OUT 2
|
||||
#define EP_DATA_IN 3
|
||||
|
||||
struct ds_device
|
||||
{
|
||||
struct usb_device *udev;
|
||||
struct usb_interface *intf;
|
||||
|
||||
int ep[NUM_EP];
|
||||
|
||||
atomic_t refcnt;
|
||||
};
|
||||
|
||||
struct ds_status
|
||||
{
|
||||
u8 enable;
|
||||
u8 speed;
|
||||
u8 pullup_dur;
|
||||
u8 ppuls_dur;
|
||||
u8 pulldown_slew;
|
||||
u8 write1_time;
|
||||
u8 write0_time;
|
||||
u8 reserved0;
|
||||
u8 status;
|
||||
u8 command0;
|
||||
u8 command1;
|
||||
u8 command_buffer_status;
|
||||
u8 data_out_buffer_status;
|
||||
u8 data_in_buffer_status;
|
||||
u8 reserved1;
|
||||
u8 reserved2;
|
||||
|
||||
};
|
||||
|
||||
int ds_touch_bit(struct ds_device *, u8, u8 *);
|
||||
int ds_read_byte(struct ds_device *, u8 *);
|
||||
int ds_read_bit(struct ds_device *, u8 *);
|
||||
int ds_write_byte(struct ds_device *, u8);
|
||||
int ds_write_bit(struct ds_device *, u8);
|
||||
int ds_start_pulse(struct ds_device *, int);
|
||||
int ds_set_speed(struct ds_device *, int);
|
||||
int ds_reset(struct ds_device *, struct ds_status *);
|
||||
int ds_detect(struct ds_device *, struct ds_status *);
|
||||
int ds_stop_pulse(struct ds_device *, int);
|
||||
struct ds_device * ds_get_device(void);
|
||||
void ds_put_device(struct ds_device *);
|
||||
int ds_write_block(struct ds_device *, u8 *, int);
|
||||
int ds_read_block(struct ds_device *, u8 *, int);
|
||||
|
||||
#endif /* __DSCORE_H */
|
||||
|
||||
247
drivers/w1/matrox_w1.c
Normal file
247
drivers/w1/matrox_w1.c
Normal file
|
|
@ -0,0 +1,247 @@
|
|||
/*
|
||||
* matrox_w1.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 <asm/atomic.h>
|
||||
#include <asm/types.h>
|
||||
#include <asm/io.h>
|
||||
|
||||
#include <linux/delay.h>
|
||||
#include <linux/kernel.h>
|
||||
#include <linux/module.h>
|
||||
#include <linux/list.h>
|
||||
#include <linux/interrupt.h>
|
||||
#include <linux/spinlock.h>
|
||||
#include <linux/timer.h>
|
||||
#include <linux/slab.h>
|
||||
#include <linux/pci_ids.h>
|
||||
#include <linux/pci.h>
|
||||
#include <linux/timer.h>
|
||||
|
||||
#include "w1.h"
|
||||
#include "w1_int.h"
|
||||
#include "w1_log.h"
|
||||
|
||||
MODULE_LICENSE("GPL");
|
||||
MODULE_AUTHOR("Evgeniy Polyakov <[email protected]>");
|
||||
MODULE_DESCRIPTION("Driver for transport(Dallas 1-wire prtocol) over VGA DDC(matrox gpio).");
|
||||
|
||||
static struct pci_device_id matrox_w1_tbl[] = {
|
||||
{ PCI_DEVICE(PCI_VENDOR_ID_MATROX, PCI_DEVICE_ID_MATROX_G400) },
|
||||
{ },
|
||||
};
|
||||
MODULE_DEVICE_TABLE(pci, matrox_w1_tbl);
|
||||
|
||||
static int __devinit matrox_w1_probe(struct pci_dev *, const struct pci_device_id *);
|
||||
static void __devexit matrox_w1_remove(struct pci_dev *);
|
||||
|
||||
static struct pci_driver matrox_w1_pci_driver = {
|
||||
.name = "matrox_w1",
|
||||
.id_table = matrox_w1_tbl,
|
||||
.probe = matrox_w1_probe,
|
||||
.remove = __devexit_p(matrox_w1_remove),
|
||||
};
|
||||
|
||||
/*
|
||||
* Matrox G400 DDC registers.
|
||||
*/
|
||||
|
||||
#define MATROX_G400_DDC_CLK (1<<4)
|
||||
#define MATROX_G400_DDC_DATA (1<<1)
|
||||
|
||||
#define MATROX_BASE 0x3C00
|
||||
#define MATROX_STATUS 0x1e14
|
||||
|
||||
#define MATROX_PORT_INDEX_OFFSET 0x00
|
||||
#define MATROX_PORT_DATA_OFFSET 0x0A
|
||||
|
||||
#define MATROX_GET_CONTROL 0x2A
|
||||
#define MATROX_GET_DATA 0x2B
|
||||
#define MATROX_CURSOR_CTL 0x06
|
||||
|
||||
struct matrox_device
|
||||
{
|
||||
void __iomem *base_addr;
|
||||
void __iomem *port_index;
|
||||
void __iomem *port_data;
|
||||
u8 data_mask;
|
||||
|
||||
unsigned long phys_addr;
|
||||
void __iomem *virt_addr;
|
||||
unsigned long found;
|
||||
|
||||
struct w1_bus_master *bus_master;
|
||||
};
|
||||
|
||||
static u8 matrox_w1_read_ddc_bit(unsigned long);
|
||||
static void matrox_w1_write_ddc_bit(unsigned long, u8);
|
||||
|
||||
/*
|
||||
* These functions read and write DDC Data bit.
|
||||
*
|
||||
* Using tristate pins, since i can't find any open-drain pin in whole motherboard.
|
||||
* Unfortunately we can't connect to Intel's 82801xx IO controller
|
||||
* since we don't know motherboard schema, wich has pretty unused(may be not) GPIO.
|
||||
*
|
||||
* I've heard that PIIX also has open drain pin.
|
||||
*
|
||||
* Port mapping.
|
||||
*/
|
||||
static __inline__ u8 matrox_w1_read_reg(struct matrox_device *dev, u8 reg)
|
||||
{
|
||||
u8 ret;
|
||||
|
||||
writeb(reg, dev->port_index);
|
||||
ret = readb(dev->port_data);
|
||||
barrier();
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
static __inline__ void matrox_w1_write_reg(struct matrox_device *dev, u8 reg, u8 val)
|
||||
{
|
||||
writeb(reg, dev->port_index);
|
||||
writeb(val, dev->port_data);
|
||||
wmb();
|
||||
}
|
||||
|
||||
static void matrox_w1_write_ddc_bit(unsigned long data, u8 bit)
|
||||
{
|
||||
u8 ret;
|
||||
struct matrox_device *dev = (struct matrox_device *) data;
|
||||
|
||||
if (bit)
|
||||
bit = 0;
|
||||
else
|
||||
bit = dev->data_mask;
|
||||
|
||||
ret = matrox_w1_read_reg(dev, MATROX_GET_CONTROL);
|
||||
matrox_w1_write_reg(dev, MATROX_GET_CONTROL, ((ret & ~dev->data_mask) | bit));
|
||||
matrox_w1_write_reg(dev, MATROX_GET_DATA, 0x00);
|
||||
}
|
||||
|
||||
static u8 matrox_w1_read_ddc_bit(unsigned long data)
|
||||
{
|
||||
u8 ret;
|
||||
struct matrox_device *dev = (struct matrox_device *) data;
|
||||
|
||||
ret = matrox_w1_read_reg(dev, MATROX_GET_DATA);
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
static void matrox_w1_hw_init(struct matrox_device *dev)
|
||||
{
|
||||
matrox_w1_write_reg(dev, MATROX_GET_DATA, 0xFF);
|
||||
matrox_w1_write_reg(dev, MATROX_GET_CONTROL, 0x00);
|
||||
}
|
||||
|
||||
static int __devinit matrox_w1_probe(struct pci_dev *pdev, const struct pci_device_id *ent)
|
||||
{
|
||||
struct matrox_device *dev;
|
||||
int err;
|
||||
|
||||
assert(pdev != NULL);
|
||||
assert(ent != NULL);
|
||||
|
||||
if (pdev->vendor != PCI_VENDOR_ID_MATROX || pdev->device != PCI_DEVICE_ID_MATROX_G400)
|
||||
return -ENODEV;
|
||||
|
||||
dev = kmalloc(sizeof(struct matrox_device) +
|
||||
sizeof(struct w1_bus_master), GFP_KERNEL);
|
||||
if (!dev) {
|
||||
dev_err(&pdev->dev,
|
||||
"%s: Failed to create new matrox_device object.\n",
|
||||
__func__);
|
||||
return -ENOMEM;
|
||||
}
|
||||
|
||||
memset(dev, 0, sizeof(struct matrox_device) + sizeof(struct w1_bus_master));
|
||||
|
||||
dev->bus_master = (struct w1_bus_master *)(dev + 1);
|
||||
|
||||
/*
|
||||
* True for G400, for some other we need resource 0, see drivers/video/matrox/matroxfb_base.c
|
||||
*/
|
||||
|
||||
dev->phys_addr = pci_resource_start(pdev, 1);
|
||||
|
||||
dev->virt_addr = ioremap_nocache(dev->phys_addr, 16384);
|
||||
if (!dev->virt_addr) {
|
||||
dev_err(&pdev->dev, "%s: failed to ioremap(0x%lx, %d).\n",
|
||||
__func__, dev->phys_addr, 16384);
|
||||
err = -EIO;
|
||||
goto err_out_free_device;
|
||||
}
|
||||
|
||||
dev->base_addr = dev->virt_addr + MATROX_BASE;
|
||||
dev->port_index = dev->base_addr + MATROX_PORT_INDEX_OFFSET;
|
||||
dev->port_data = dev->base_addr + MATROX_PORT_DATA_OFFSET;
|
||||
dev->data_mask = (MATROX_G400_DDC_DATA);
|
||||
|
||||
matrox_w1_hw_init(dev);
|
||||
|
||||
dev->bus_master->data = (unsigned long) dev;
|
||||
dev->bus_master->read_bit = &matrox_w1_read_ddc_bit;
|
||||
dev->bus_master->write_bit = &matrox_w1_write_ddc_bit;
|
||||
|
||||
err = w1_add_master_device(dev->bus_master);
|
||||
if (err)
|
||||
goto err_out_free_device;
|
||||
|
||||
pci_set_drvdata(pdev, dev);
|
||||
|
||||
dev->found = 1;
|
||||
|
||||
dev_info(&pdev->dev, "Matrox G400 GPIO transport layer for 1-wire.\n");
|
||||
|
||||
return 0;
|
||||
|
||||
err_out_free_device:
|
||||
kfree(dev);
|
||||
|
||||
return err;
|
||||
}
|
||||
|
||||
static void __devexit matrox_w1_remove(struct pci_dev *pdev)
|
||||
{
|
||||
struct matrox_device *dev = pci_get_drvdata(pdev);
|
||||
|
||||
assert(dev != NULL);
|
||||
|
||||
if (dev->found) {
|
||||
w1_remove_master_device(dev->bus_master);
|
||||
iounmap(dev->virt_addr);
|
||||
}
|
||||
kfree(dev);
|
||||
}
|
||||
|
||||
static int __init matrox_w1_init(void)
|
||||
{
|
||||
return pci_register_driver(&matrox_w1_pci_driver);
|
||||
}
|
||||
|
||||
static void __exit matrox_w1_fini(void)
|
||||
{
|
||||
pci_unregister_driver(&matrox_w1_pci_driver);
|
||||
}
|
||||
|
||||
module_init(matrox_w1_init);
|
||||
module_exit(matrox_w1_fini);
|
||||
835
drivers/w1/w1.c
Normal file
835
drivers/w1/w1.c
Normal file
|
|
@ -0,0 +1,835 @@
|
|||
/*
|
||||
* w1.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/delay.h>
|
||||
#include <linux/kernel.h>
|
||||
#include <linux/module.h>
|
||||
#include <linux/moduleparam.h>
|
||||
#include <linux/list.h>
|
||||
#include <linux/interrupt.h>
|
||||
#include <linux/spinlock.h>
|
||||
#include <linux/timer.h>
|
||||
#include <linux/device.h>
|
||||
#include <linux/slab.h>
|
||||
#include <linux/sched.h>
|
||||
|
||||
#include <asm/atomic.h>
|
||||
|
||||
#include "w1.h"
|
||||
#include "w1_io.h"
|
||||
#include "w1_log.h"
|
||||
#include "w1_int.h"
|
||||
#include "w1_family.h"
|
||||
#include "w1_netlink.h"
|
||||
|
||||
MODULE_LICENSE("GPL");
|
||||
MODULE_AUTHOR("Evgeniy Polyakov <[email protected]>");
|
||||
MODULE_DESCRIPTION("Driver for 1-wire Dallas network protocol.");
|
||||
|
||||
static int w1_timeout = 10;
|
||||
int w1_max_slave_count = 10;
|
||||
int w1_max_slave_ttl = 10;
|
||||
|
||||
module_param_named(timeout, w1_timeout, int, 0);
|
||||
module_param_named(max_slave_count, w1_max_slave_count, int, 0);
|
||||
module_param_named(slave_ttl, w1_max_slave_ttl, int, 0);
|
||||
|
||||
DEFINE_SPINLOCK(w1_mlock);
|
||||
LIST_HEAD(w1_masters);
|
||||
|
||||
static pid_t control_thread;
|
||||
static int control_needs_exit;
|
||||
static DECLARE_COMPLETION(w1_control_complete);
|
||||
|
||||
static int w1_master_match(struct device *dev, struct device_driver *drv)
|
||||
{
|
||||
return 1;
|
||||
}
|
||||
|
||||
static int w1_master_probe(struct device *dev)
|
||||
{
|
||||
return -ENODEV;
|
||||
}
|
||||
|
||||
static int w1_master_remove(struct device *dev)
|
||||
{
|
||||
return 0;
|
||||
}
|
||||
|
||||
static void w1_master_release(struct device *dev)
|
||||
{
|
||||
struct w1_master *md = container_of(dev, struct w1_master, dev);
|
||||
|
||||
complete(&md->dev_released);
|
||||
}
|
||||
|
||||
static void w1_slave_release(struct device *dev)
|
||||
{
|
||||
struct w1_slave *sl = container_of(dev, struct w1_slave, dev);
|
||||
|
||||
complete(&sl->dev_released);
|
||||
}
|
||||
|
||||
static ssize_t w1_default_read_name(struct device *dev, char *buf)
|
||||
{
|
||||
return sprintf(buf, "No family registered.\n");
|
||||
}
|
||||
|
||||
static ssize_t w1_default_read_bin(struct kobject *kobj, char *buf, loff_t off,
|
||||
size_t count)
|
||||
{
|
||||
return sprintf(buf, "No family registered.\n");
|
||||
}
|
||||
|
||||
static struct bus_type w1_bus_type = {
|
||||
.name = "w1",
|
||||
.match = w1_master_match,
|
||||
};
|
||||
|
||||
struct device_driver w1_driver = {
|
||||
.name = "w1_driver",
|
||||
.bus = &w1_bus_type,
|
||||
.probe = w1_master_probe,
|
||||
.remove = w1_master_remove,
|
||||
};
|
||||
|
||||
struct device w1_device = {
|
||||
.parent = NULL,
|
||||
.bus = &w1_bus_type,
|
||||
.bus_id = "w1 bus master",
|
||||
.driver = &w1_driver,
|
||||
.release = &w1_master_release
|
||||
};
|
||||
|
||||
static struct device_attribute w1_slave_attribute = {
|
||||
.attr = {
|
||||
.name = "name",
|
||||
.mode = S_IRUGO,
|
||||
.owner = THIS_MODULE
|
||||
},
|
||||
.show = &w1_default_read_name,
|
||||
};
|
||||
|
||||
static struct device_attribute w1_slave_attribute_val = {
|
||||
.attr = {
|
||||
.name = "value",
|
||||
.mode = S_IRUGO,
|
||||
.owner = THIS_MODULE
|
||||
},
|
||||
.show = &w1_default_read_name,
|
||||
};
|
||||
|
||||
static ssize_t w1_master_attribute_show_name(struct device *dev, char *buf)
|
||||
{
|
||||
struct w1_master *md = container_of (dev, struct w1_master, dev);
|
||||
ssize_t count;
|
||||
|
||||
if (down_interruptible (&md->mutex))
|
||||
return -EBUSY;
|
||||
|
||||
count = sprintf(buf, "%s\n", md->name);
|
||||
|
||||
up(&md->mutex);
|
||||
|
||||
return count;
|
||||
}
|
||||
|
||||
static ssize_t w1_master_attribute_show_pointer(struct device *dev, char *buf)
|
||||
{
|
||||
struct w1_master *md = container_of(dev, struct w1_master, dev);
|
||||
ssize_t count;
|
||||
|
||||
if (down_interruptible(&md->mutex))
|
||||
return -EBUSY;
|
||||
|
||||
count = sprintf(buf, "0x%p\n", md->bus_master);
|
||||
|
||||
up(&md->mutex);
|
||||
return count;
|
||||
}
|
||||
|
||||
static ssize_t w1_master_attribute_show_timeout(struct device *dev, char *buf)
|
||||
{
|
||||
ssize_t count;
|
||||
count = sprintf(buf, "%d\n", w1_timeout);
|
||||
return count;
|
||||
}
|
||||
|
||||
static ssize_t w1_master_attribute_show_max_slave_count(struct device *dev, char *buf)
|
||||
{
|
||||
struct w1_master *md = container_of(dev, struct w1_master, dev);
|
||||
ssize_t count;
|
||||
|
||||
if (down_interruptible(&md->mutex))
|
||||
return -EBUSY;
|
||||
|
||||
count = sprintf(buf, "%d\n", md->max_slave_count);
|
||||
|
||||
up(&md->mutex);
|
||||
return count;
|
||||
}
|
||||
|
||||
static ssize_t w1_master_attribute_show_attempts(struct device *dev, char *buf)
|
||||
{
|
||||
struct w1_master *md = container_of(dev, struct w1_master, dev);
|
||||
ssize_t count;
|
||||
|
||||
if (down_interruptible(&md->mutex))
|
||||
return -EBUSY;
|
||||
|
||||
count = sprintf(buf, "%lu\n", md->attempts);
|
||||
|
||||
up(&md->mutex);
|
||||
return count;
|
||||
}
|
||||
|
||||
static ssize_t w1_master_attribute_show_slave_count(struct device *dev, char *buf)
|
||||
{
|
||||
struct w1_master *md = container_of(dev, struct w1_master, dev);
|
||||
ssize_t count;
|
||||
|
||||
if (down_interruptible(&md->mutex))
|
||||
return -EBUSY;
|
||||
|
||||
count = sprintf(buf, "%d\n", md->slave_count);
|
||||
|
||||
up(&md->mutex);
|
||||
return count;
|
||||
}
|
||||
|
||||
static ssize_t w1_master_attribute_show_slaves(struct device *dev, char *buf)
|
||||
|
||||
{
|
||||
struct w1_master *md = container_of(dev, struct w1_master, dev);
|
||||
int c = PAGE_SIZE;
|
||||
|
||||
if (down_interruptible(&md->mutex))
|
||||
return -EBUSY;
|
||||
|
||||
if (md->slave_count == 0)
|
||||
c -= snprintf(buf + PAGE_SIZE - c, c, "not found.\n");
|
||||
else {
|
||||
struct list_head *ent, *n;
|
||||
struct w1_slave *sl;
|
||||
|
||||
list_for_each_safe(ent, n, &md->slist) {
|
||||
sl = list_entry(ent, struct w1_slave, w1_slave_entry);
|
||||
|
||||
c -= snprintf(buf + PAGE_SIZE - c, c, "%s\n", sl->name);
|
||||
}
|
||||
}
|
||||
|
||||
up(&md->mutex);
|
||||
|
||||
return PAGE_SIZE - c;
|
||||
}
|
||||
|
||||
static struct device_attribute w1_master_attribute_slaves = {
|
||||
.attr = {
|
||||
.name = "w1_master_slaves",
|
||||
.mode = S_IRUGO,
|
||||
.owner = THIS_MODULE,
|
||||
},
|
||||
.show = &w1_master_attribute_show_slaves,
|
||||
};
|
||||
static struct device_attribute w1_master_attribute_slave_count = {
|
||||
.attr = {
|
||||
.name = "w1_master_slave_count",
|
||||
.mode = S_IRUGO,
|
||||
.owner = THIS_MODULE
|
||||
},
|
||||
.show = &w1_master_attribute_show_slave_count,
|
||||
};
|
||||
static struct device_attribute w1_master_attribute_attempts = {
|
||||
.attr = {
|
||||
.name = "w1_master_attempts",
|
||||
.mode = S_IRUGO,
|
||||
.owner = THIS_MODULE
|
||||
},
|
||||
.show = &w1_master_attribute_show_attempts,
|
||||
};
|
||||
static struct device_attribute w1_master_attribute_max_slave_count = {
|
||||
.attr = {
|
||||
.name = "w1_master_max_slave_count",
|
||||
.mode = S_IRUGO,
|
||||
.owner = THIS_MODULE
|
||||
},
|
||||
.show = &w1_master_attribute_show_max_slave_count,
|
||||
};
|
||||
static struct device_attribute w1_master_attribute_timeout = {
|
||||
.attr = {
|
||||
.name = "w1_master_timeout",
|
||||
.mode = S_IRUGO,
|
||||
.owner = THIS_MODULE
|
||||
},
|
||||
.show = &w1_master_attribute_show_timeout,
|
||||
};
|
||||
static struct device_attribute w1_master_attribute_pointer = {
|
||||
.attr = {
|
||||
.name = "w1_master_pointer",
|
||||
.mode = S_IRUGO,
|
||||
.owner = THIS_MODULE
|
||||
},
|
||||
.show = &w1_master_attribute_show_pointer,
|
||||
};
|
||||
static struct device_attribute w1_master_attribute_name = {
|
||||
.attr = {
|
||||
.name = "w1_master_name",
|
||||
.mode = S_IRUGO,
|
||||
.owner = THIS_MODULE
|
||||
},
|
||||
.show = &w1_master_attribute_show_name,
|
||||
};
|
||||
|
||||
static struct bin_attribute w1_slave_bin_attribute = {
|
||||
.attr = {
|
||||
.name = "w1_slave",
|
||||
.mode = S_IRUGO,
|
||||
.owner = THIS_MODULE,
|
||||
},
|
||||
.size = W1_SLAVE_DATA_SIZE,
|
||||
.read = &w1_default_read_bin,
|
||||
};
|
||||
|
||||
static int __w1_attach_slave_device(struct w1_slave *sl)
|
||||
{
|
||||
int err;
|
||||
|
||||
sl->dev.parent = &sl->master->dev;
|
||||
sl->dev.driver = sl->master->driver;
|
||||
sl->dev.bus = &w1_bus_type;
|
||||
sl->dev.release = &w1_slave_release;
|
||||
|
||||
snprintf(&sl->dev.bus_id[0], sizeof(sl->dev.bus_id),
|
||||
"%02x-%012llx",
|
||||
(unsigned int) sl->reg_num.family,
|
||||
(unsigned long long) sl->reg_num.id);
|
||||
snprintf (&sl->name[0], sizeof(sl->name),
|
||||
"%02x-%012llx",
|
||||
(unsigned int) sl->reg_num.family,
|
||||
(unsigned long long) sl->reg_num.id);
|
||||
|
||||
dev_dbg(&sl->dev, "%s: registering %s.\n", __func__,
|
||||
&sl->dev.bus_id[0]);
|
||||
|
||||
err = device_register(&sl->dev);
|
||||
if (err < 0) {
|
||||
dev_err(&sl->dev,
|
||||
"Device registration [%s] failed. err=%d\n",
|
||||
sl->dev.bus_id, err);
|
||||
return err;
|
||||
}
|
||||
|
||||
memcpy(&sl->attr_bin, &w1_slave_bin_attribute, sizeof(sl->attr_bin));
|
||||
memcpy(&sl->attr_name, &w1_slave_attribute, sizeof(sl->attr_name));
|
||||
memcpy(&sl->attr_val, &w1_slave_attribute_val, sizeof(sl->attr_val));
|
||||
|
||||
sl->attr_bin.read = sl->family->fops->rbin;
|
||||
sl->attr_name.show = sl->family->fops->rname;
|
||||
sl->attr_val.show = sl->family->fops->rval;
|
||||
sl->attr_val.attr.name = sl->family->fops->rvalname;
|
||||
|
||||
err = device_create_file(&sl->dev, &sl->attr_name);
|
||||
if (err < 0) {
|
||||
dev_err(&sl->dev,
|
||||
"sysfs file creation for [%s] failed. err=%d\n",
|
||||
sl->dev.bus_id, err);
|
||||
device_unregister(&sl->dev);
|
||||
return err;
|
||||
}
|
||||
|
||||
err = device_create_file(&sl->dev, &sl->attr_val);
|
||||
if (err < 0) {
|
||||
dev_err(&sl->dev,
|
||||
"sysfs file creation for [%s] failed. err=%d\n",
|
||||
sl->dev.bus_id, err);
|
||||
device_remove_file(&sl->dev, &sl->attr_name);
|
||||
device_unregister(&sl->dev);
|
||||
return err;
|
||||
}
|
||||
|
||||
err = sysfs_create_bin_file(&sl->dev.kobj, &sl->attr_bin);
|
||||
if (err < 0) {
|
||||
dev_err(&sl->dev,
|
||||
"sysfs file creation for [%s] failed. err=%d\n",
|
||||
sl->dev.bus_id, err);
|
||||
device_remove_file(&sl->dev, &sl->attr_name);
|
||||
device_remove_file(&sl->dev, &sl->attr_val);
|
||||
device_unregister(&sl->dev);
|
||||
return err;
|
||||
}
|
||||
|
||||
list_add_tail(&sl->w1_slave_entry, &sl->master->slist);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int w1_attach_slave_device(struct w1_master *dev, struct w1_reg_num *rn)
|
||||
{
|
||||
struct w1_slave *sl;
|
||||
struct w1_family *f;
|
||||
int err;
|
||||
struct w1_netlink_msg msg;
|
||||
|
||||
sl = kmalloc(sizeof(struct w1_slave), GFP_KERNEL);
|
||||
if (!sl) {
|
||||
dev_err(&dev->dev,
|
||||
"%s: failed to allocate new slave device.\n",
|
||||
__func__);
|
||||
return -ENOMEM;
|
||||
}
|
||||
|
||||
memset(sl, 0, sizeof(*sl));
|
||||
|
||||
sl->owner = THIS_MODULE;
|
||||
sl->master = dev;
|
||||
set_bit(W1_SLAVE_ACTIVE, (long *)&sl->flags);
|
||||
|
||||
memcpy(&sl->reg_num, rn, sizeof(sl->reg_num));
|
||||
atomic_set(&sl->refcnt, 0);
|
||||
init_completion(&sl->dev_released);
|
||||
|
||||
spin_lock(&w1_flock);
|
||||
f = w1_family_registered(rn->family);
|
||||
if (!f) {
|
||||
spin_unlock(&w1_flock);
|
||||
dev_info(&dev->dev, "Family %x for %02x.%012llx.%02x is not registered.\n",
|
||||
rn->family, rn->family,
|
||||
(unsigned long long)rn->id, rn->crc);
|
||||
kfree(sl);
|
||||
return -ENODEV;
|
||||
}
|
||||
__w1_family_get(f);
|
||||
spin_unlock(&w1_flock);
|
||||
|
||||
sl->family = f;
|
||||
|
||||
|
||||
err = __w1_attach_slave_device(sl);
|
||||
if (err < 0) {
|
||||
dev_err(&dev->dev, "%s: Attaching %s failed.\n", __func__,
|
||||
sl->name);
|
||||
w1_family_put(sl->family);
|
||||
kfree(sl);
|
||||
return err;
|
||||
}
|
||||
|
||||
sl->ttl = dev->slave_ttl;
|
||||
dev->slave_count++;
|
||||
|
||||
memcpy(&msg.id.id, rn, sizeof(msg.id.id));
|
||||
msg.type = W1_SLAVE_ADD;
|
||||
w1_netlink_send(dev, &msg);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static void w1_slave_detach(struct w1_slave *sl)
|
||||
{
|
||||
struct w1_netlink_msg msg;
|
||||
|
||||
dev_info(&sl->dev, "%s: detaching %s.\n", __func__, sl->name);
|
||||
|
||||
while (atomic_read(&sl->refcnt)) {
|
||||
printk(KERN_INFO "Waiting for %s to become free: refcnt=%d.\n",
|
||||
sl->name, atomic_read(&sl->refcnt));
|
||||
|
||||
if (msleep_interruptible(1000))
|
||||
flush_signals(current);
|
||||
}
|
||||
|
||||
sysfs_remove_bin_file (&sl->dev.kobj, &sl->attr_bin);
|
||||
device_remove_file(&sl->dev, &sl->attr_name);
|
||||
device_remove_file(&sl->dev, &sl->attr_val);
|
||||
device_unregister(&sl->dev);
|
||||
w1_family_put(sl->family);
|
||||
|
||||
memcpy(&msg.id.id, &sl->reg_num, sizeof(msg.id.id));
|
||||
msg.type = W1_SLAVE_REMOVE;
|
||||
w1_netlink_send(sl->master, &msg);
|
||||
}
|
||||
|
||||
static struct w1_master *w1_search_master(unsigned long data)
|
||||
{
|
||||
struct w1_master *dev;
|
||||
int found = 0;
|
||||
|
||||
spin_lock_irq(&w1_mlock);
|
||||
list_for_each_entry(dev, &w1_masters, w1_master_entry) {
|
||||
if (dev->bus_master->data == data) {
|
||||
found = 1;
|
||||
atomic_inc(&dev->refcnt);
|
||||
break;
|
||||
}
|
||||
}
|
||||
spin_unlock_irq(&w1_mlock);
|
||||
|
||||
return (found)?dev:NULL;
|
||||
}
|
||||
|
||||
void w1_slave_found(unsigned long data, u64 rn)
|
||||
{
|
||||
int slave_count;
|
||||
struct w1_slave *sl;
|
||||
struct list_head *ent;
|
||||
struct w1_reg_num *tmp;
|
||||
int family_found = 0;
|
||||
struct w1_master *dev;
|
||||
|
||||
dev = w1_search_master(data);
|
||||
if (!dev) {
|
||||
printk(KERN_ERR "Failed to find w1 master device for data %08lx, it is impossible.\n",
|
||||
data);
|
||||
return;
|
||||
}
|
||||
|
||||
tmp = (struct w1_reg_num *) &rn;
|
||||
|
||||
slave_count = 0;
|
||||
list_for_each(ent, &dev->slist) {
|
||||
|
||||
sl = list_entry(ent, struct w1_slave, w1_slave_entry);
|
||||
|
||||
if (sl->reg_num.family == tmp->family &&
|
||||
sl->reg_num.id == tmp->id &&
|
||||
sl->reg_num.crc == tmp->crc) {
|
||||
set_bit(W1_SLAVE_ACTIVE, (long *)&sl->flags);
|
||||
break;
|
||||
}
|
||||
else if (sl->reg_num.family == tmp->family) {
|
||||
family_found = 1;
|
||||
break;
|
||||
}
|
||||
|
||||
slave_count++;
|
||||
}
|
||||
|
||||
if (slave_count == dev->slave_count && rn ) {
|
||||
tmp = cpu_to_le64(rn);
|
||||
if(((rn >> 56) & 0xff) == w1_calc_crc8((u8 *)&tmp, 7))
|
||||
w1_attach_slave_device(dev, (struct w1_reg_num *) &rn);
|
||||
}
|
||||
|
||||
atomic_dec(&dev->refcnt);
|
||||
}
|
||||
|
||||
void w1_search(struct w1_master *dev)
|
||||
{
|
||||
u64 last, rn, tmp;
|
||||
int i, count = 0;
|
||||
int last_family_desc, last_zero, last_device;
|
||||
int search_bit, id_bit, comp_bit, desc_bit;
|
||||
|
||||
search_bit = id_bit = comp_bit = 0;
|
||||
rn = tmp = last = 0;
|
||||
last_device = last_zero = last_family_desc = 0;
|
||||
|
||||
desc_bit = 64;
|
||||
|
||||
while (!(id_bit && comp_bit) && !last_device
|
||||
&& count++ < dev->max_slave_count) {
|
||||
last = rn;
|
||||
rn = 0;
|
||||
|
||||
last_family_desc = 0;
|
||||
|
||||
/*
|
||||
* Reset bus and all 1-wire device state machines
|
||||
* so they can respond to our requests.
|
||||
*
|
||||
* Return 0 - device(s) present, 1 - no devices present.
|
||||
*/
|
||||
if (w1_reset_bus(dev)) {
|
||||
dev_info(&dev->dev, "No devices present on the wire.\n");
|
||||
break;
|
||||
}
|
||||
|
||||
#if 1
|
||||
w1_write_8(dev, W1_SEARCH);
|
||||
for (i = 0; i < 64; ++i) {
|
||||
/*
|
||||
* Read 2 bits from bus.
|
||||
* All who don't sleep must send ID bit and COMPLEMENT ID bit.
|
||||
* They actually are ANDed between all senders.
|
||||
*/
|
||||
id_bit = w1_touch_bit(dev, 1);
|
||||
comp_bit = w1_touch_bit(dev, 1);
|
||||
|
||||
if (id_bit && comp_bit)
|
||||
break;
|
||||
|
||||
if (id_bit == 0 && comp_bit == 0) {
|
||||
if (i == desc_bit)
|
||||
search_bit = 1;
|
||||
else if (i > desc_bit)
|
||||
search_bit = 0;
|
||||
else
|
||||
search_bit = ((last >> i) & 0x1);
|
||||
|
||||
if (search_bit == 0) {
|
||||
last_zero = i;
|
||||
if (last_zero < 9)
|
||||
last_family_desc = last_zero;
|
||||
}
|
||||
|
||||
}
|
||||
else
|
||||
search_bit = id_bit;
|
||||
|
||||
tmp = search_bit;
|
||||
rn |= (tmp << i);
|
||||
|
||||
/*
|
||||
* Write 1 bit to bus
|
||||
* and make all who don't have "search_bit" in "i"'th position
|
||||
* in it's registration number sleep.
|
||||
*/
|
||||
if (dev->bus_master->touch_bit)
|
||||
w1_touch_bit(dev, search_bit);
|
||||
else
|
||||
w1_write_bit(dev, search_bit);
|
||||
|
||||
}
|
||||
#endif
|
||||
|
||||
if (desc_bit == last_zero)
|
||||
last_device = 1;
|
||||
|
||||
desc_bit = last_zero;
|
||||
|
||||
w1_slave_found(dev->bus_master->data, rn);
|
||||
}
|
||||
}
|
||||
|
||||
int w1_create_master_attributes(struct w1_master *dev)
|
||||
{
|
||||
if ( device_create_file(&dev->dev, &w1_master_attribute_slaves) < 0 ||
|
||||
device_create_file(&dev->dev, &w1_master_attribute_slave_count) < 0 ||
|
||||
device_create_file(&dev->dev, &w1_master_attribute_attempts) < 0 ||
|
||||
device_create_file(&dev->dev, &w1_master_attribute_max_slave_count) < 0 ||
|
||||
device_create_file(&dev->dev, &w1_master_attribute_timeout) < 0||
|
||||
device_create_file(&dev->dev, &w1_master_attribute_pointer) < 0||
|
||||
device_create_file(&dev->dev, &w1_master_attribute_name) < 0)
|
||||
return -EINVAL;
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
void w1_destroy_master_attributes(struct w1_master *dev)
|
||||
{
|
||||
device_remove_file(&dev->dev, &w1_master_attribute_slaves);
|
||||
device_remove_file(&dev->dev, &w1_master_attribute_slave_count);
|
||||
device_remove_file(&dev->dev, &w1_master_attribute_attempts);
|
||||
device_remove_file(&dev->dev, &w1_master_attribute_max_slave_count);
|
||||
device_remove_file(&dev->dev, &w1_master_attribute_timeout);
|
||||
device_remove_file(&dev->dev, &w1_master_attribute_pointer);
|
||||
device_remove_file(&dev->dev, &w1_master_attribute_name);
|
||||
}
|
||||
|
||||
|
||||
int w1_control(void *data)
|
||||
{
|
||||
struct w1_slave *sl;
|
||||
struct w1_master *dev;
|
||||
struct list_head *ent, *ment, *n, *mn;
|
||||
int err, have_to_wait = 0;
|
||||
|
||||
daemonize("w1_control");
|
||||
allow_signal(SIGTERM);
|
||||
|
||||
while (!control_needs_exit || have_to_wait) {
|
||||
have_to_wait = 0;
|
||||
|
||||
try_to_freeze(PF_FREEZE);
|
||||
msleep_interruptible(w1_timeout * 1000);
|
||||
|
||||
if (signal_pending(current))
|
||||
flush_signals(current);
|
||||
|
||||
list_for_each_safe(ment, mn, &w1_masters) {
|
||||
dev = list_entry(ment, struct w1_master, w1_master_entry);
|
||||
|
||||
if (!control_needs_exit && !dev->need_exit)
|
||||
continue;
|
||||
/*
|
||||
* Little race: we can create thread but not set the flag.
|
||||
* Get a chance for external process to set flag up.
|
||||
*/
|
||||
if (!dev->initialized) {
|
||||
have_to_wait = 1;
|
||||
continue;
|
||||
}
|
||||
|
||||
spin_lock(&w1_mlock);
|
||||
list_del(&dev->w1_master_entry);
|
||||
spin_unlock(&w1_mlock);
|
||||
|
||||
if (control_needs_exit) {
|
||||
dev->need_exit = 1;
|
||||
|
||||
err = kill_proc(dev->kpid, SIGTERM, 1);
|
||||
if (err)
|
||||
dev_err(&dev->dev,
|
||||
"Failed to send signal to w1 kernel thread %d.\n",
|
||||
dev->kpid);
|
||||
}
|
||||
|
||||
wait_for_completion(&dev->dev_exited);
|
||||
|
||||
list_for_each_safe(ent, n, &dev->slist) {
|
||||
sl = list_entry(ent, struct w1_slave, w1_slave_entry);
|
||||
|
||||
if (!sl)
|
||||
dev_warn(&dev->dev,
|
||||
"%s: slave entry is NULL.\n",
|
||||
__func__);
|
||||
else {
|
||||
list_del(&sl->w1_slave_entry);
|
||||
|
||||
w1_slave_detach(sl);
|
||||
kfree(sl);
|
||||
}
|
||||
}
|
||||
w1_destroy_master_attributes(dev);
|
||||
atomic_dec(&dev->refcnt);
|
||||
}
|
||||
}
|
||||
|
||||
complete_and_exit(&w1_control_complete, 0);
|
||||
}
|
||||
|
||||
int w1_process(void *data)
|
||||
{
|
||||
struct w1_master *dev = (struct w1_master *) data;
|
||||
struct list_head *ent, *n;
|
||||
struct w1_slave *sl;
|
||||
|
||||
daemonize("%s", dev->name);
|
||||
allow_signal(SIGTERM);
|
||||
|
||||
while (!dev->need_exit) {
|
||||
try_to_freeze(PF_FREEZE);
|
||||
msleep_interruptible(w1_timeout * 1000);
|
||||
|
||||
if (signal_pending(current))
|
||||
flush_signals(current);
|
||||
|
||||
if (dev->need_exit)
|
||||
break;
|
||||
|
||||
if (!dev->initialized)
|
||||
continue;
|
||||
|
||||
if (down_interruptible(&dev->mutex))
|
||||
continue;
|
||||
|
||||
list_for_each_safe(ent, n, &dev->slist) {
|
||||
sl = list_entry(ent, struct w1_slave, w1_slave_entry);
|
||||
|
||||
if (sl)
|
||||
clear_bit(W1_SLAVE_ACTIVE, (long *)&sl->flags);
|
||||
}
|
||||
|
||||
w1_search_devices(dev, w1_slave_found);
|
||||
|
||||
list_for_each_safe(ent, n, &dev->slist) {
|
||||
sl = list_entry(ent, struct w1_slave, w1_slave_entry);
|
||||
|
||||
if (sl && !test_bit(W1_SLAVE_ACTIVE, (unsigned long *)&sl->flags) && !--sl->ttl) {
|
||||
list_del (&sl->w1_slave_entry);
|
||||
|
||||
w1_slave_detach (sl);
|
||||
kfree (sl);
|
||||
|
||||
dev->slave_count--;
|
||||
}
|
||||
else if (test_bit(W1_SLAVE_ACTIVE, (unsigned long *)&sl->flags))
|
||||
sl->ttl = dev->slave_ttl;
|
||||
}
|
||||
up(&dev->mutex);
|
||||
}
|
||||
|
||||
atomic_dec(&dev->refcnt);
|
||||
complete_and_exit(&dev->dev_exited, 0);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
int w1_init(void)
|
||||
{
|
||||
int retval;
|
||||
|
||||
printk(KERN_INFO "Driver for 1-wire Dallas network protocol.\n");
|
||||
|
||||
retval = bus_register(&w1_bus_type);
|
||||
if (retval) {
|
||||
printk(KERN_ERR "Failed to register bus. err=%d.\n", retval);
|
||||
goto err_out_exit_init;
|
||||
}
|
||||
|
||||
retval = driver_register(&w1_driver);
|
||||
if (retval) {
|
||||
printk(KERN_ERR
|
||||
"Failed to register master driver. err=%d.\n",
|
||||
retval);
|
||||
goto err_out_bus_unregister;
|
||||
}
|
||||
|
||||
control_thread = kernel_thread(&w1_control, NULL, 0);
|
||||
if (control_thread < 0) {
|
||||
printk(KERN_ERR "Failed to create control thread. err=%d\n",
|
||||
control_thread);
|
||||
retval = control_thread;
|
||||
goto err_out_driver_unregister;
|
||||
}
|
||||
|
||||
return 0;
|
||||
|
||||
err_out_driver_unregister:
|
||||
driver_unregister(&w1_driver);
|
||||
|
||||
err_out_bus_unregister:
|
||||
bus_unregister(&w1_bus_type);
|
||||
|
||||
err_out_exit_init:
|
||||
return retval;
|
||||
}
|
||||
|
||||
void w1_fini(void)
|
||||
{
|
||||
struct w1_master *dev;
|
||||
struct list_head *ent, *n;
|
||||
|
||||
list_for_each_safe(ent, n, &w1_masters) {
|
||||
dev = list_entry(ent, struct w1_master, w1_master_entry);
|
||||
__w1_remove_master_device(dev);
|
||||
}
|
||||
|
||||
control_needs_exit = 1;
|
||||
|
||||
wait_for_completion(&w1_control_complete);
|
||||
|
||||
driver_unregister(&w1_driver);
|
||||
bus_unregister(&w1_bus_type);
|
||||
}
|
||||
|
||||
module_init(w1_init);
|
||||
module_exit(w1_fini);
|
||||
145
drivers/w1/w1.h
Normal file
145
drivers/w1/w1.h
Normal file
|
|
@ -0,0 +1,145 @@
|
|||
/*
|
||||
* w1.h
|
||||
*
|
||||
* 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
|
||||
*/
|
||||
|
||||
#ifndef __W1_H
|
||||
#define __W1_H
|
||||
|
||||
struct w1_reg_num
|
||||
{
|
||||
#if defined(__LITTLE_ENDIAN_BITFIELD)
|
||||
__u64 family:8,
|
||||
id:48,
|
||||
crc:8;
|
||||
#elif defined(__BIG_ENDIAN_BITFIELD)
|
||||
__u64 crc:8,
|
||||
id:48,
|
||||
family:8;
|
||||
#else
|
||||
#error "Please fix <asm/byteorder.h>"
|
||||
#endif
|
||||
};
|
||||
|
||||
#ifdef __KERNEL__
|
||||
|
||||
#include <linux/completion.h>
|
||||
#include <linux/device.h>
|
||||
|
||||
#include <net/sock.h>
|
||||
|
||||
#include <asm/semaphore.h>
|
||||
|
||||
#include "w1_family.h"
|
||||
|
||||
#define W1_MAXNAMELEN 32
|
||||
#define W1_SLAVE_DATA_SIZE 128
|
||||
|
||||
#define W1_SEARCH 0xF0
|
||||
#define W1_CONDITIONAL_SEARCH 0xEC
|
||||
#define W1_CONVERT_TEMP 0x44
|
||||
#define W1_SKIP_ROM 0xCC
|
||||
#define W1_READ_SCRATCHPAD 0xBE
|
||||
#define W1_READ_ROM 0x33
|
||||
#define W1_READ_PSUPPLY 0xB4
|
||||
#define W1_MATCH_ROM 0x55
|
||||
|
||||
#define W1_SLAVE_ACTIVE (1<<0)
|
||||
|
||||
struct w1_slave
|
||||
{
|
||||
struct module *owner;
|
||||
unsigned char name[W1_MAXNAMELEN];
|
||||
struct list_head w1_slave_entry;
|
||||
struct w1_reg_num reg_num;
|
||||
atomic_t refcnt;
|
||||
u8 rom[9];
|
||||
u32 flags;
|
||||
int ttl;
|
||||
|
||||
struct w1_master *master;
|
||||
struct w1_family *family;
|
||||
struct device dev;
|
||||
struct completion dev_released;
|
||||
|
||||
struct bin_attribute attr_bin;
|
||||
struct device_attribute attr_name, attr_val;
|
||||
};
|
||||
|
||||
typedef void (* w1_slave_found_callback)(unsigned long, u64);
|
||||
|
||||
struct w1_bus_master
|
||||
{
|
||||
unsigned long data;
|
||||
|
||||
u8 (*read_bit)(unsigned long);
|
||||
void (*write_bit)(unsigned long, u8);
|
||||
|
||||
u8 (*read_byte)(unsigned long);
|
||||
void (*write_byte)(unsigned long, u8);
|
||||
|
||||
u8 (*read_block)(unsigned long, u8 *, int);
|
||||
void (*write_block)(unsigned long, u8 *, int);
|
||||
|
||||
u8 (*touch_bit)(unsigned long, u8);
|
||||
|
||||
u8 (*reset_bus)(unsigned long);
|
||||
|
||||
void (*search)(unsigned long, w1_slave_found_callback);
|
||||
};
|
||||
|
||||
struct w1_master
|
||||
{
|
||||
struct list_head w1_master_entry;
|
||||
struct module *owner;
|
||||
unsigned char name[W1_MAXNAMELEN];
|
||||
struct list_head slist;
|
||||
int max_slave_count, slave_count;
|
||||
unsigned long attempts;
|
||||
int slave_ttl;
|
||||
int initialized;
|
||||
u32 id;
|
||||
|
||||
atomic_t refcnt;
|
||||
|
||||
void *priv;
|
||||
int priv_size;
|
||||
|
||||
int need_exit;
|
||||
pid_t kpid;
|
||||
struct semaphore mutex;
|
||||
|
||||
struct device_driver *driver;
|
||||
struct device dev;
|
||||
struct completion dev_released;
|
||||
struct completion dev_exited;
|
||||
|
||||
struct w1_bus_master *bus_master;
|
||||
|
||||
u32 seq, groups;
|
||||
struct sock *nls;
|
||||
};
|
||||
|
||||
int w1_create_master_attributes(struct w1_master *);
|
||||
void w1_destroy_master_attributes(struct w1_master *);
|
||||
void w1_search(struct w1_master *dev);
|
||||
|
||||
#endif /* __KERNEL__ */
|
||||
|
||||
#endif /* __W1_H */
|
||||
150
drivers/w1/w1_family.c
Normal file
150
drivers/w1/w1_family.c
Normal file
|
|
@ -0,0 +1,150 @@
|
|||
/*
|
||||
* w1_family.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/spinlock.h>
|
||||
#include <linux/list.h>
|
||||
#include <linux/delay.h>
|
||||
|
||||
#include "w1_family.h"
|
||||
|
||||
DEFINE_SPINLOCK(w1_flock);
|
||||
static LIST_HEAD(w1_families);
|
||||
|
||||
static int w1_check_family(struct w1_family *f)
|
||||
{
|
||||
if (!f->fops->rname || !f->fops->rbin || !f->fops->rval || !f->fops->rvalname)
|
||||
return -EINVAL;
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
int w1_register_family(struct w1_family *newf)
|
||||
{
|
||||
struct list_head *ent, *n;
|
||||
struct w1_family *f;
|
||||
int ret = 0;
|
||||
|
||||
if (w1_check_family(newf))
|
||||
return -EINVAL;
|
||||
|
||||
spin_lock(&w1_flock);
|
||||
list_for_each_safe(ent, n, &w1_families) {
|
||||
f = list_entry(ent, struct w1_family, family_entry);
|
||||
|
||||
if (f->fid == newf->fid) {
|
||||
ret = -EEXIST;
|
||||
break;
|
||||
}
|
||||
}
|
||||
|
||||
if (!ret) {
|
||||
atomic_set(&newf->refcnt, 0);
|
||||
newf->need_exit = 0;
|
||||
list_add_tail(&newf->family_entry, &w1_families);
|
||||
}
|
||||
|
||||
spin_unlock(&w1_flock);
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
void w1_unregister_family(struct w1_family *fent)
|
||||
{
|
||||
struct list_head *ent, *n;
|
||||
struct w1_family *f;
|
||||
|
||||
spin_lock(&w1_flock);
|
||||
list_for_each_safe(ent, n, &w1_families) {
|
||||
f = list_entry(ent, struct w1_family, family_entry);
|
||||
|
||||
if (f->fid == fent->fid) {
|
||||
list_del(&fent->family_entry);
|
||||
break;
|
||||
}
|
||||
}
|
||||
|
||||
fent->need_exit = 1;
|
||||
|
||||
spin_unlock(&w1_flock);
|
||||
|
||||
while (atomic_read(&fent->refcnt)) {
|
||||
printk(KERN_INFO "Waiting for family %u to become free: refcnt=%d.\n",
|
||||
fent->fid, atomic_read(&fent->refcnt));
|
||||
|
||||
if (msleep_interruptible(1000))
|
||||
flush_signals(current);
|
||||
}
|
||||
}
|
||||
|
||||
/*
|
||||
* Should be called under w1_flock held.
|
||||
*/
|
||||
struct w1_family * w1_family_registered(u8 fid)
|
||||
{
|
||||
struct list_head *ent, *n;
|
||||
struct w1_family *f = NULL;
|
||||
int ret = 0;
|
||||
|
||||
list_for_each_safe(ent, n, &w1_families) {
|
||||
f = list_entry(ent, struct w1_family, family_entry);
|
||||
|
||||
if (f->fid == fid) {
|
||||
ret = 1;
|
||||
break;
|
||||
}
|
||||
}
|
||||
|
||||
return (ret) ? f : NULL;
|
||||
}
|
||||
|
||||
void w1_family_put(struct w1_family *f)
|
||||
{
|
||||
spin_lock(&w1_flock);
|
||||
__w1_family_put(f);
|
||||
spin_unlock(&w1_flock);
|
||||
}
|
||||
|
||||
void __w1_family_put(struct w1_family *f)
|
||||
{
|
||||
if (atomic_dec_and_test(&f->refcnt))
|
||||
f->need_exit = 1;
|
||||
}
|
||||
|
||||
void w1_family_get(struct w1_family *f)
|
||||
{
|
||||
spin_lock(&w1_flock);
|
||||
__w1_family_get(f);
|
||||
spin_unlock(&w1_flock);
|
||||
|
||||
}
|
||||
|
||||
void __w1_family_get(struct w1_family *f)
|
||||
{
|
||||
smp_mb__before_atomic_inc();
|
||||
atomic_inc(&f->refcnt);
|
||||
smp_mb__after_atomic_inc();
|
||||
}
|
||||
|
||||
EXPORT_SYMBOL(w1_family_get);
|
||||
EXPORT_SYMBOL(w1_family_put);
|
||||
EXPORT_SYMBOL(w1_family_registered);
|
||||
EXPORT_SYMBOL(w1_unregister_family);
|
||||
EXPORT_SYMBOL(w1_register_family);
|
||||
65
drivers/w1/w1_family.h
Normal file
65
drivers/w1/w1_family.h
Normal file
|
|
@ -0,0 +1,65 @@
|
|||
/*
|
||||
* w1_family.h
|
||||
*
|
||||
* 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
|
||||
*/
|
||||
|
||||
#ifndef __W1_FAMILY_H
|
||||
#define __W1_FAMILY_H
|
||||
|
||||
#include <linux/types.h>
|
||||
#include <linux/device.h>
|
||||
#include <asm/atomic.h>
|
||||
|
||||
#define W1_FAMILY_DEFAULT 0
|
||||
#define W1_FAMILY_THERM 0x10
|
||||
#define W1_FAMILY_SMEM 0x01
|
||||
|
||||
#define MAXNAMELEN 32
|
||||
|
||||
struct w1_family_ops
|
||||
{
|
||||
ssize_t (* rname)(struct device *, char *);
|
||||
ssize_t (* rbin)(struct kobject *, char *, loff_t, size_t);
|
||||
|
||||
ssize_t (* rval)(struct device *, char *);
|
||||
unsigned char rvalname[MAXNAMELEN];
|
||||
};
|
||||
|
||||
struct w1_family
|
||||
{
|
||||
struct list_head family_entry;
|
||||
u8 fid;
|
||||
|
||||
struct w1_family_ops *fops;
|
||||
|
||||
atomic_t refcnt;
|
||||
u8 need_exit;
|
||||
};
|
||||
|
||||
extern spinlock_t w1_flock;
|
||||
|
||||
void w1_family_get(struct w1_family *);
|
||||
void w1_family_put(struct w1_family *);
|
||||
void __w1_family_get(struct w1_family *);
|
||||
void __w1_family_put(struct w1_family *);
|
||||
struct w1_family * w1_family_registered(u8);
|
||||
void w1_unregister_family(struct w1_family *);
|
||||
int w1_register_family(struct w1_family *);
|
||||
|
||||
#endif /* __W1_FAMILY_H */
|
||||
220
drivers/w1/w1_int.c
Normal file
220
drivers/w1/w1_int.c
Normal file
|
|
@ -0,0 +1,220 @@
|
|||
/*
|
||||
* w1_int.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/kernel.h>
|
||||
#include <linux/list.h>
|
||||
#include <linux/delay.h>
|
||||
|
||||
#include "w1.h"
|
||||
#include "w1_log.h"
|
||||
#include "w1_netlink.h"
|
||||
|
||||
static u32 w1_ids = 1;
|
||||
|
||||
extern struct device_driver w1_driver;
|
||||
extern struct bus_type w1_bus_type;
|
||||
extern struct device w1_device;
|
||||
extern int w1_max_slave_count;
|
||||
extern int w1_max_slave_ttl;
|
||||
extern struct list_head w1_masters;
|
||||
extern spinlock_t w1_mlock;
|
||||
|
||||
extern int w1_process(void *);
|
||||
|
||||
struct w1_master * w1_alloc_dev(u32 id, int slave_count, int slave_ttl,
|
||||
struct device_driver *driver, struct device *device)
|
||||
{
|
||||
struct w1_master *dev;
|
||||
int err;
|
||||
|
||||
/*
|
||||
* We are in process context(kernel thread), so can sleep.
|
||||
*/
|
||||
dev = kmalloc(sizeof(struct w1_master) + sizeof(struct w1_bus_master), GFP_KERNEL);
|
||||
if (!dev) {
|
||||
printk(KERN_ERR
|
||||
"Failed to allocate %zd bytes for new w1 device.\n",
|
||||
sizeof(struct w1_master));
|
||||
return NULL;
|
||||
}
|
||||
|
||||
memset(dev, 0, sizeof(struct w1_master) + sizeof(struct w1_bus_master));
|
||||
|
||||
dev->bus_master = (struct w1_bus_master *)(dev + 1);
|
||||
|
||||
dev->owner = THIS_MODULE;
|
||||
dev->max_slave_count = slave_count;
|
||||
dev->slave_count = 0;
|
||||
dev->attempts = 0;
|
||||
dev->kpid = -1;
|
||||
dev->initialized = 0;
|
||||
dev->id = id;
|
||||
dev->slave_ttl = slave_ttl;
|
||||
|
||||
atomic_set(&dev->refcnt, 2);
|
||||
|
||||
INIT_LIST_HEAD(&dev->slist);
|
||||
init_MUTEX(&dev->mutex);
|
||||
|
||||
init_completion(&dev->dev_released);
|
||||
init_completion(&dev->dev_exited);
|
||||
|
||||
memcpy(&dev->dev, device, sizeof(struct device));
|
||||
snprintf(dev->dev.bus_id, sizeof(dev->dev.bus_id),
|
||||
"w1_bus_master%u", dev->id);
|
||||
snprintf(dev->name, sizeof(dev->name), "w1_bus_master%u", dev->id);
|
||||
|
||||
dev->driver = driver;
|
||||
|
||||
dev->groups = 23;
|
||||
dev->seq = 1;
|
||||
dev->nls = netlink_kernel_create(NETLINK_NFLOG, NULL);
|
||||
if (!dev->nls) {
|
||||
printk(KERN_ERR "Failed to create new netlink socket(%u) for w1 master %s.\n",
|
||||
NETLINK_NFLOG, dev->dev.bus_id);
|
||||
}
|
||||
|
||||
err = device_register(&dev->dev);
|
||||
if (err) {
|
||||
printk(KERN_ERR "Failed to register master device. err=%d\n", err);
|
||||
if (dev->nls && dev->nls->sk_socket)
|
||||
sock_release(dev->nls->sk_socket);
|
||||
memset(dev, 0, sizeof(struct w1_master));
|
||||
kfree(dev);
|
||||
dev = NULL;
|
||||
}
|
||||
|
||||
return dev;
|
||||
}
|
||||
|
||||
void w1_free_dev(struct w1_master *dev)
|
||||
{
|
||||
device_unregister(&dev->dev);
|
||||
if (dev->nls && dev->nls->sk_socket)
|
||||
sock_release(dev->nls->sk_socket);
|
||||
memset(dev, 0, sizeof(struct w1_master) + sizeof(struct w1_bus_master));
|
||||
kfree(dev);
|
||||
}
|
||||
|
||||
int w1_add_master_device(struct w1_bus_master *master)
|
||||
{
|
||||
struct w1_master *dev;
|
||||
int retval = 0;
|
||||
struct w1_netlink_msg msg;
|
||||
|
||||
dev = w1_alloc_dev(w1_ids++, w1_max_slave_count, w1_max_slave_ttl, &w1_driver, &w1_device);
|
||||
if (!dev)
|
||||
return -ENOMEM;
|
||||
|
||||
dev->kpid = kernel_thread(&w1_process, dev, 0);
|
||||
if (dev->kpid < 0) {
|
||||
dev_err(&dev->dev,
|
||||
"Failed to create new kernel thread. err=%d\n",
|
||||
dev->kpid);
|
||||
retval = dev->kpid;
|
||||
goto err_out_free_dev;
|
||||
}
|
||||
|
||||
retval = w1_create_master_attributes(dev);
|
||||
if (retval)
|
||||
goto err_out_kill_thread;
|
||||
|
||||
memcpy(dev->bus_master, master, sizeof(struct w1_bus_master));
|
||||
|
||||
dev->initialized = 1;
|
||||
|
||||
spin_lock(&w1_mlock);
|
||||
list_add(&dev->w1_master_entry, &w1_masters);
|
||||
spin_unlock(&w1_mlock);
|
||||
|
||||
msg.id.mst.id = dev->id;
|
||||
msg.id.mst.pid = dev->kpid;
|
||||
msg.type = W1_MASTER_ADD;
|
||||
w1_netlink_send(dev, &msg);
|
||||
|
||||
return 0;
|
||||
|
||||
err_out_kill_thread:
|
||||
dev->need_exit = 1;
|
||||
if (kill_proc(dev->kpid, SIGTERM, 1))
|
||||
dev_err(&dev->dev,
|
||||
"Failed to send signal to w1 kernel thread %d.\n",
|
||||
dev->kpid);
|
||||
wait_for_completion(&dev->dev_exited);
|
||||
|
||||
err_out_free_dev:
|
||||
w1_free_dev(dev);
|
||||
|
||||
return retval;
|
||||
}
|
||||
|
||||
void __w1_remove_master_device(struct w1_master *dev)
|
||||
{
|
||||
int err;
|
||||
struct w1_netlink_msg msg;
|
||||
|
||||
dev->need_exit = 1;
|
||||
err = kill_proc(dev->kpid, SIGTERM, 1);
|
||||
if (err)
|
||||
dev_err(&dev->dev,
|
||||
"%s: Failed to send signal to w1 kernel thread %d.\n",
|
||||
__func__, dev->kpid);
|
||||
|
||||
while (atomic_read(&dev->refcnt)) {
|
||||
printk(KERN_INFO "Waiting for %s to become free: refcnt=%d.\n",
|
||||
dev->name, atomic_read(&dev->refcnt));
|
||||
|
||||
if (msleep_interruptible(1000))
|
||||
flush_signals(current);
|
||||
}
|
||||
|
||||
msg.id.mst.id = dev->id;
|
||||
msg.id.mst.pid = dev->kpid;
|
||||
msg.type = W1_MASTER_REMOVE;
|
||||
w1_netlink_send(dev, &msg);
|
||||
|
||||
w1_free_dev(dev);
|
||||
}
|
||||
|
||||
void w1_remove_master_device(struct w1_bus_master *bm)
|
||||
{
|
||||
struct w1_master *dev = NULL;
|
||||
struct list_head *ent, *n;
|
||||
|
||||
list_for_each_safe(ent, n, &w1_masters) {
|
||||
dev = list_entry(ent, struct w1_master, w1_master_entry);
|
||||
if (!dev->initialized)
|
||||
continue;
|
||||
|
||||
if (dev->bus_master->data == bm->data)
|
||||
break;
|
||||
}
|
||||
|
||||
if (!dev) {
|
||||
printk(KERN_ERR "Device doesn't exist.\n");
|
||||
return;
|
||||
}
|
||||
|
||||
__w1_remove_master_device(dev);
|
||||
}
|
||||
|
||||
EXPORT_SYMBOL(w1_add_master_device);
|
||||
EXPORT_SYMBOL(w1_remove_master_device);
|
||||
36
drivers/w1/w1_int.h
Normal file
36
drivers/w1/w1_int.h
Normal file
|
|
@ -0,0 +1,36 @@
|
|||
/*
|
||||
* w1_int.h
|
||||
*
|
||||
* 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
|
||||
*/
|
||||
|
||||
#ifndef __W1_INT_H
|
||||
#define __W1_INT_H
|
||||
|
||||
#include <linux/kernel.h>
|
||||
#include <linux/device.h>
|
||||
|
||||
#include "w1.h"
|
||||
|
||||
struct w1_master * w1_alloc_dev(u32, int, int, struct device_driver *, struct device *);
|
||||
void w1_free_dev(struct w1_master *dev);
|
||||
int w1_add_master_device(struct w1_bus_master *);
|
||||
void w1_remove_master_device(struct w1_bus_master *);
|
||||
void __w1_remove_master_device(struct w1_master *);
|
||||
|
||||
#endif /* __W1_INT_H */
|
||||
195
drivers/w1/w1_io.c
Normal file
195
drivers/w1/w1_io.c
Normal file
|
|
@ -0,0 +1,195 @@
|
|||
/*
|
||||
* w1_io.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 <asm/io.h>
|
||||
|
||||
#include <linux/delay.h>
|
||||
#include <linux/moduleparam.h>
|
||||
|
||||
#include "w1.h"
|
||||
#include "w1_log.h"
|
||||
#include "w1_io.h"
|
||||
|
||||
int w1_delay_parm = 1;
|
||||
module_param_named(delay_coef, w1_delay_parm, int, 0);
|
||||
|
||||
static u8 w1_crc8_table[] = {
|
||||
0, 94, 188, 226, 97, 63, 221, 131, 194, 156, 126, 32, 163, 253, 31, 65,
|
||||
157, 195, 33, 127, 252, 162, 64, 30, 95, 1, 227, 189, 62, 96, 130, 220,
|
||||
35, 125, 159, 193, 66, 28, 254, 160, 225, 191, 93, 3, 128, 222, 60, 98,
|
||||
190, 224, 2, 92, 223, 129, 99, 61, 124, 34, 192, 158, 29, 67, 161, 255,
|
||||
70, 24, 250, 164, 39, 121, 155, 197, 132, 218, 56, 102, 229, 187, 89, 7,
|
||||
219, 133, 103, 57, 186, 228, 6, 88, 25, 71, 165, 251, 120, 38, 196, 154,
|
||||
101, 59, 217, 135, 4, 90, 184, 230, 167, 249, 27, 69, 198, 152, 122, 36,
|
||||
248, 166, 68, 26, 153, 199, 37, 123, 58, 100, 134, 216, 91, 5, 231, 185,
|
||||
140, 210, 48, 110, 237, 179, 81, 15, 78, 16, 242, 172, 47, 113, 147, 205,
|
||||
17, 79, 173, 243, 112, 46, 204, 146, 211, 141, 111, 49, 178, 236, 14, 80,
|
||||
175, 241, 19, 77, 206, 144, 114, 44, 109, 51, 209, 143, 12, 82, 176, 238,
|
||||
50, 108, 142, 208, 83, 13, 239, 177, 240, 174, 76, 18, 145, 207, 45, 115,
|
||||
202, 148, 118, 40, 171, 245, 23, 73, 8, 86, 180, 234, 105, 55, 213, 139,
|
||||
87, 9, 235, 181, 54, 104, 138, 212, 149, 203, 41, 119, 244, 170, 72, 22,
|
||||
233, 183, 85, 11, 136, 214, 52, 106, 43, 117, 151, 201, 74, 20, 246, 168,
|
||||
116, 42, 200, 150, 21, 75, 169, 247, 182, 232, 10, 84, 215, 137, 107, 53
|
||||
};
|
||||
|
||||
void w1_delay(unsigned long tm)
|
||||
{
|
||||
udelay(tm * w1_delay_parm);
|
||||
}
|
||||
|
||||
u8 w1_touch_bit(struct w1_master *dev, int bit)
|
||||
{
|
||||
if (dev->bus_master->touch_bit)
|
||||
return dev->bus_master->touch_bit(dev->bus_master->data, bit);
|
||||
else
|
||||
return w1_read_bit(dev);
|
||||
}
|
||||
|
||||
void w1_write_bit(struct w1_master *dev, int bit)
|
||||
{
|
||||
if (bit) {
|
||||
dev->bus_master->write_bit(dev->bus_master->data, 0);
|
||||
w1_delay(6);
|
||||
dev->bus_master->write_bit(dev->bus_master->data, 1);
|
||||
w1_delay(64);
|
||||
} else {
|
||||
dev->bus_master->write_bit(dev->bus_master->data, 0);
|
||||
w1_delay(60);
|
||||
dev->bus_master->write_bit(dev->bus_master->data, 1);
|
||||
w1_delay(10);
|
||||
}
|
||||
}
|
||||
|
||||
void w1_write_8(struct w1_master *dev, u8 byte)
|
||||
{
|
||||
int i;
|
||||
|
||||
if (dev->bus_master->write_byte)
|
||||
dev->bus_master->write_byte(dev->bus_master->data, byte);
|
||||
else
|
||||
for (i = 0; i < 8; ++i)
|
||||
w1_write_bit(dev, (byte >> i) & 0x1);
|
||||
}
|
||||
|
||||
u8 w1_read_bit(struct w1_master *dev)
|
||||
{
|
||||
int result;
|
||||
|
||||
dev->bus_master->write_bit(dev->bus_master->data, 0);
|
||||
w1_delay(6);
|
||||
dev->bus_master->write_bit(dev->bus_master->data, 1);
|
||||
w1_delay(9);
|
||||
|
||||
result = dev->bus_master->read_bit(dev->bus_master->data);
|
||||
w1_delay(55);
|
||||
|
||||
return result & 0x1;
|
||||
}
|
||||
|
||||
u8 w1_read_8(struct w1_master * dev)
|
||||
{
|
||||
int i;
|
||||
u8 res = 0;
|
||||
|
||||
if (dev->bus_master->read_byte)
|
||||
res = dev->bus_master->read_byte(dev->bus_master->data);
|
||||
else
|
||||
for (i = 0; i < 8; ++i)
|
||||
res |= (w1_read_bit(dev) << i);
|
||||
|
||||
return res;
|
||||
}
|
||||
|
||||
void w1_write_block(struct w1_master *dev, u8 *buf, int len)
|
||||
{
|
||||
int i;
|
||||
|
||||
if (dev->bus_master->write_block)
|
||||
dev->bus_master->write_block(dev->bus_master->data, buf, len);
|
||||
else
|
||||
for (i = 0; i < len; ++i)
|
||||
w1_write_8(dev, buf[i]);
|
||||
}
|
||||
|
||||
u8 w1_read_block(struct w1_master *dev, u8 *buf, int len)
|
||||
{
|
||||
int i;
|
||||
u8 ret;
|
||||
|
||||
if (dev->bus_master->read_block)
|
||||
ret = dev->bus_master->read_block(dev->bus_master->data, buf, len);
|
||||
else {
|
||||
for (i = 0; i < len; ++i)
|
||||
buf[i] = w1_read_8(dev);
|
||||
ret = len;
|
||||
}
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
int w1_reset_bus(struct w1_master *dev)
|
||||
{
|
||||
int result = 0;
|
||||
|
||||
if (dev->bus_master->reset_bus)
|
||||
result = dev->bus_master->reset_bus(dev->bus_master->data) & 0x1;
|
||||
else {
|
||||
dev->bus_master->write_bit(dev->bus_master->data, 0);
|
||||
w1_delay(480);
|
||||
dev->bus_master->write_bit(dev->bus_master->data, 1);
|
||||
w1_delay(70);
|
||||
|
||||
result = dev->bus_master->read_bit(dev->bus_master->data) & 0x1;
|
||||
w1_delay(410);
|
||||
}
|
||||
|
||||
return result;
|
||||
}
|
||||
|
||||
u8 w1_calc_crc8(u8 * data, int len)
|
||||
{
|
||||
u8 crc = 0;
|
||||
|
||||
while (len--)
|
||||
crc = w1_crc8_table[crc ^ *data++];
|
||||
|
||||
return crc;
|
||||
}
|
||||
|
||||
void w1_search_devices(struct w1_master *dev, w1_slave_found_callback cb)
|
||||
{
|
||||
dev->attempts++;
|
||||
if (dev->bus_master->search)
|
||||
dev->bus_master->search(dev->bus_master->data, cb);
|
||||
else
|
||||
w1_search(dev);
|
||||
}
|
||||
|
||||
EXPORT_SYMBOL(w1_write_bit);
|
||||
EXPORT_SYMBOL(w1_write_8);
|
||||
EXPORT_SYMBOL(w1_read_bit);
|
||||
EXPORT_SYMBOL(w1_read_8);
|
||||
EXPORT_SYMBOL(w1_reset_bus);
|
||||
EXPORT_SYMBOL(w1_calc_crc8);
|
||||
EXPORT_SYMBOL(w1_delay);
|
||||
EXPORT_SYMBOL(w1_read_block);
|
||||
EXPORT_SYMBOL(w1_write_block);
|
||||
EXPORT_SYMBOL(w1_search_devices);
|
||||
39
drivers/w1/w1_io.h
Normal file
39
drivers/w1/w1_io.h
Normal file
|
|
@ -0,0 +1,39 @@
|
|||
/*
|
||||
* w1_io.h
|
||||
*
|
||||
* 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
|
||||
*/
|
||||
|
||||
#ifndef __W1_IO_H
|
||||
#define __W1_IO_H
|
||||
|
||||
#include "w1.h"
|
||||
|
||||
void w1_delay(unsigned long);
|
||||
u8 w1_touch_bit(struct w1_master *, int);
|
||||
void w1_write_bit(struct w1_master *, int);
|
||||
void w1_write_8(struct w1_master *, u8);
|
||||
u8 w1_read_bit(struct w1_master *);
|
||||
u8 w1_read_8(struct w1_master *);
|
||||
int w1_reset_bus(struct w1_master *);
|
||||
u8 w1_calc_crc8(u8 *, int);
|
||||
void w1_write_block(struct w1_master *, u8 *, int);
|
||||
u8 w1_read_block(struct w1_master *, u8 *, int);
|
||||
void w1_search_devices(struct w1_master *dev, w1_slave_found_callback cb);
|
||||
|
||||
#endif /* __W1_IO_H */
|
||||
38
drivers/w1/w1_log.h
Normal file
38
drivers/w1/w1_log.h
Normal file
|
|
@ -0,0 +1,38 @@
|
|||
/*
|
||||
* w1_log.h
|
||||
*
|
||||
* 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
|
||||
*/
|
||||
|
||||
#ifndef __W1_LOG_H
|
||||
#define __W1_LOG_H
|
||||
|
||||
#define DEBUG
|
||||
|
||||
#ifdef W1_DEBUG
|
||||
# define assert(expr) do {} while (0)
|
||||
#else
|
||||
# define assert(expr) \
|
||||
if(unlikely(!(expr))) { \
|
||||
printk(KERN_ERR "Assertion failed! %s,%s,%s,line=%d\n", \
|
||||
#expr,__FILE__,__FUNCTION__,__LINE__); \
|
||||
}
|
||||
#endif
|
||||
|
||||
#endif /* __W1_LOG_H */
|
||||
|
||||
66
drivers/w1/w1_netlink.c
Normal file
66
drivers/w1/w1_netlink.c
Normal file
|
|
@ -0,0 +1,66 @@
|
|||
/*
|
||||
* w1_netlink.c
|
||||
*
|
||||
* Copyright (c) 2003 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/skbuff.h>
|
||||
#include <linux/netlink.h>
|
||||
|
||||
#include "w1.h"
|
||||
#include "w1_log.h"
|
||||
#include "w1_netlink.h"
|
||||
|
||||
#ifndef NETLINK_DISABLED
|
||||
void w1_netlink_send(struct w1_master *dev, struct w1_netlink_msg *msg)
|
||||
{
|
||||
unsigned int size;
|
||||
struct sk_buff *skb;
|
||||
struct w1_netlink_msg *data;
|
||||
struct nlmsghdr *nlh;
|
||||
|
||||
if (!dev->nls)
|
||||
return;
|
||||
|
||||
size = NLMSG_SPACE(sizeof(struct w1_netlink_msg));
|
||||
|
||||
skb = alloc_skb(size, GFP_ATOMIC);
|
||||
if (!skb) {
|
||||
dev_err(&dev->dev, "skb_alloc() failed.\n");
|
||||
return;
|
||||
}
|
||||
|
||||
nlh = NLMSG_PUT(skb, 0, dev->seq++, NLMSG_DONE, size - sizeof(*nlh));
|
||||
|
||||
data = (struct w1_netlink_msg *)NLMSG_DATA(nlh);
|
||||
|
||||
memcpy(data, msg, sizeof(struct w1_netlink_msg));
|
||||
|
||||
NETLINK_CB(skb).dst_groups = dev->groups;
|
||||
netlink_broadcast(dev->nls, skb, 0, dev->groups, GFP_ATOMIC);
|
||||
|
||||
nlmsg_failure:
|
||||
return;
|
||||
}
|
||||
#else
|
||||
#warning Netlink support is disabled. Please compile with NET support enabled.
|
||||
|
||||
void w1_netlink_send(struct w1_master *dev, struct w1_netlink_msg *msg)
|
||||
{
|
||||
}
|
||||
#endif
|
||||
57
drivers/w1/w1_netlink.h
Normal file
57
drivers/w1/w1_netlink.h
Normal file
|
|
@ -0,0 +1,57 @@
|
|||
/*
|
||||
* w1_netlink.h
|
||||
*
|
||||
* Copyright (c) 2003 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
|
||||
*/
|
||||
|
||||
#ifndef __W1_NETLINK_H
|
||||
#define __W1_NETLINK_H
|
||||
|
||||
#include <asm/types.h>
|
||||
|
||||
#include "w1.h"
|
||||
|
||||
enum w1_netlink_message_types {
|
||||
W1_SLAVE_ADD = 0,
|
||||
W1_SLAVE_REMOVE,
|
||||
W1_MASTER_ADD,
|
||||
W1_MASTER_REMOVE,
|
||||
};
|
||||
|
||||
struct w1_netlink_msg
|
||||
{
|
||||
__u8 type;
|
||||
__u8 reserved[3];
|
||||
union
|
||||
{
|
||||
struct w1_reg_num id;
|
||||
__u64 w1_id;
|
||||
struct
|
||||
{
|
||||
__u32 id;
|
||||
__u32 pid;
|
||||
} mst;
|
||||
} id;
|
||||
};
|
||||
|
||||
#ifdef __KERNEL__
|
||||
|
||||
void w1_netlink_send(struct w1_master *, struct w1_netlink_msg *);
|
||||
|
||||
#endif /* __KERNEL__ */
|
||||
#endif /* __W1_NETLINK_H */
|
||||
118
drivers/w1/w1_smem.c
Normal file
118
drivers/w1/w1_smem.c
Normal file
|
|
@ -0,0 +1,118 @@
|
|||
/*
|
||||
* w1_smem.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 smems 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 <asm/types.h>
|
||||
|
||||
#include <linux/kernel.h>
|
||||
#include <linux/module.h>
|
||||
#include <linux/moduleparam.h>
|
||||
#include <linux/device.h>
|
||||
#include <linux/types.h>
|
||||
|
||||
#include "w1.h"
|
||||
#include "w1_io.h"
|
||||
#include "w1_int.h"
|
||||
#include "w1_family.h"
|
||||
|
||||
MODULE_LICENSE("GPL");
|
||||
MODULE_AUTHOR("Evgeniy Polyakov <[email protected]>");
|
||||
MODULE_DESCRIPTION("Driver for 1-wire Dallas network protocol, 64bit memory family.");
|
||||
|
||||
static ssize_t w1_smem_read_name(struct device *, char *);
|
||||
static ssize_t w1_smem_read_val(struct device *, char *);
|
||||
static ssize_t w1_smem_read_bin(struct kobject *, char *, loff_t, size_t);
|
||||
|
||||
static struct w1_family_ops w1_smem_fops = {
|
||||
.rname = &w1_smem_read_name,
|
||||
.rbin = &w1_smem_read_bin,
|
||||
.rval = &w1_smem_read_val,
|
||||
.rvalname = "id",
|
||||
};
|
||||
|
||||
static ssize_t w1_smem_read_name(struct device *dev, char *buf)
|
||||
{
|
||||
struct w1_slave *sl = container_of(dev, struct w1_slave, dev);
|
||||
|
||||
return sprintf(buf, "%s\n", sl->name);
|
||||
}
|
||||
|
||||
static ssize_t w1_smem_read_val(struct device *dev, char *buf)
|
||||
{
|
||||
struct w1_slave *sl = container_of(dev, struct w1_slave, dev);
|
||||
int i;
|
||||
ssize_t count = 0;
|
||||
|
||||
for (i = 0; i < 9; ++i)
|
||||
count += sprintf(buf + count, "%02x ", ((u8 *)&sl->reg_num)[i]);
|
||||
count += sprintf(buf + count, "\n");
|
||||
|
||||
return count;
|
||||
}
|
||||
|
||||
static ssize_t w1_smem_read_bin(struct kobject *kobj, char *buf, loff_t off, size_t count)
|
||||
{
|
||||
struct w1_slave *sl = container_of(container_of(kobj, struct device, kobj),
|
||||
struct w1_slave, dev);
|
||||
int i;
|
||||
|
||||
atomic_inc(&sl->refcnt);
|
||||
if (down_interruptible(&sl->master->mutex)) {
|
||||
count = 0;
|
||||
goto out_dec;
|
||||
}
|
||||
|
||||
if (off > W1_SLAVE_DATA_SIZE) {
|
||||
count = 0;
|
||||
goto out;
|
||||
}
|
||||
if (off + count > W1_SLAVE_DATA_SIZE) {
|
||||
count = 0;
|
||||
goto out;
|
||||
}
|
||||
for (i = 0; i < 9; ++i)
|
||||
count += sprintf(buf + count, "%02x ", ((u8 *)&sl->reg_num)[i]);
|
||||
count += sprintf(buf + count, "\n");
|
||||
|
||||
out:
|
||||
up(&sl->master->mutex);
|
||||
out_dec:
|
||||
atomic_dec(&sl->refcnt);
|
||||
|
||||
return count;
|
||||
}
|
||||
|
||||
static struct w1_family w1_smem_family = {
|
||||
.fid = W1_FAMILY_SMEM,
|
||||
.fops = &w1_smem_fops,
|
||||
};
|
||||
|
||||
static int __init w1_smem_init(void)
|
||||
{
|
||||
return w1_register_family(&w1_smem_family);
|
||||
}
|
||||
|
||||
static void __exit w1_smem_fini(void)
|
||||
{
|
||||
w1_unregister_family(&w1_smem_family);
|
||||
}
|
||||
|
||||
module_init(w1_smem_init);
|
||||
module_exit(w1_smem_fini);
|
||||
205
drivers/w1/w1_therm.c
Normal file
205
drivers/w1/w1_therm.c
Normal file
|
|
@ -0,0 +1,205 @@
|
|||
/*
|
||||
* w1_therm.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 therms 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 <asm/types.h>
|
||||
|
||||
#include <linux/kernel.h>
|
||||
#include <linux/module.h>
|
||||
#include <linux/moduleparam.h>
|
||||
#include <linux/device.h>
|
||||
#include <linux/types.h>
|
||||
#include <linux/delay.h>
|
||||
|
||||
#include "w1.h"
|
||||
#include "w1_io.h"
|
||||
#include "w1_int.h"
|
||||
#include "w1_family.h"
|
||||
|
||||
MODULE_LICENSE("GPL");
|
||||
MODULE_AUTHOR("Evgeniy Polyakov <[email protected]>");
|
||||
MODULE_DESCRIPTION("Driver for 1-wire Dallas network protocol, temperature family.");
|
||||
|
||||
static u8 bad_roms[][9] = {
|
||||
{0xaa, 0x00, 0x4b, 0x46, 0xff, 0xff, 0x0c, 0x10, 0x87},
|
||||
{}
|
||||
};
|
||||
|
||||
static ssize_t w1_therm_read_name(struct device *, char *);
|
||||
static ssize_t w1_therm_read_temp(struct device *, char *);
|
||||
static ssize_t w1_therm_read_bin(struct kobject *, char *, loff_t, size_t);
|
||||
|
||||
static struct w1_family_ops w1_therm_fops = {
|
||||
.rname = &w1_therm_read_name,
|
||||
.rbin = &w1_therm_read_bin,
|
||||
.rval = &w1_therm_read_temp,
|
||||
.rvalname = "temp1_input",
|
||||
};
|
||||
|
||||
static ssize_t w1_therm_read_name(struct device *dev, char *buf)
|
||||
{
|
||||
struct w1_slave *sl = container_of(dev, struct w1_slave, dev);
|
||||
|
||||
return sprintf(buf, "%s\n", sl->name);
|
||||
}
|
||||
|
||||
static inline int w1_convert_temp(u8 rom[9])
|
||||
{
|
||||
int t, h;
|
||||
|
||||
if (rom[1] == 0)
|
||||
t = ((s32)rom[0] >> 1)*1000;
|
||||
else
|
||||
t = 1000*(-1*(s32)(0x100-rom[0]) >> 1);
|
||||
|
||||
t -= 250;
|
||||
h = 1000*((s32)rom[7] - (s32)rom[6]);
|
||||
h /= (s32)rom[7];
|
||||
t += h;
|
||||
|
||||
return t;
|
||||
}
|
||||
|
||||
static ssize_t w1_therm_read_temp(struct device *dev, char *buf)
|
||||
{
|
||||
struct w1_slave *sl = container_of(dev, struct w1_slave, dev);
|
||||
|
||||
return sprintf(buf, "%d\n", w1_convert_temp(sl->rom));
|
||||
}
|
||||
|
||||
static int w1_therm_check_rom(u8 rom[9])
|
||||
{
|
||||
int i;
|
||||
|
||||
for (i=0; i<sizeof(bad_roms)/9; ++i)
|
||||
if (!memcmp(bad_roms[i], rom, 9))
|
||||
return 1;
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static ssize_t w1_therm_read_bin(struct kobject *kobj, char *buf, loff_t off, size_t count)
|
||||
{
|
||||
struct w1_slave *sl = container_of(container_of(kobj, struct device, kobj),
|
||||
struct w1_slave, dev);
|
||||
struct w1_master *dev = sl->master;
|
||||
u8 rom[9], crc, verdict;
|
||||
int i, max_trying = 10;
|
||||
|
||||
atomic_inc(&sl->refcnt);
|
||||
smp_mb__after_atomic_inc();
|
||||
if (down_interruptible(&sl->master->mutex)) {
|
||||
count = 0;
|
||||
goto out_dec;
|
||||
}
|
||||
|
||||
if (off > W1_SLAVE_DATA_SIZE) {
|
||||
count = 0;
|
||||
goto out;
|
||||
}
|
||||
if (off + count > W1_SLAVE_DATA_SIZE) {
|
||||
count = 0;
|
||||
goto out;
|
||||
}
|
||||
|
||||
memset(buf, 0, count);
|
||||
memset(rom, 0, sizeof(rom));
|
||||
|
||||
count = 0;
|
||||
verdict = 0;
|
||||
crc = 0;
|
||||
|
||||
while (max_trying--) {
|
||||
if (!w1_reset_bus (dev)) {
|
||||
int count = 0;
|
||||
u8 match[9] = {W1_MATCH_ROM, };
|
||||
unsigned int tm = 750;
|
||||
|
||||
memcpy(&match[1], (u64 *) & sl->reg_num, 8);
|
||||
|
||||
w1_write_block(dev, match, 9);
|
||||
|
||||
w1_write_8(dev, W1_CONVERT_TEMP);
|
||||
|
||||
while (tm) {
|
||||
tm = msleep_interruptible(tm);
|
||||
if (signal_pending(current))
|
||||
flush_signals(current);
|
||||
}
|
||||
|
||||
if (!w1_reset_bus (dev)) {
|
||||
w1_write_block(dev, match, 9);
|
||||
|
||||
w1_write_8(dev, W1_READ_SCRATCHPAD);
|
||||
if ((count = w1_read_block(dev, rom, 9)) != 9) {
|
||||
dev_warn(&dev->dev, "w1_read_block() returned %d instead of 9.\n", count);
|
||||
}
|
||||
|
||||
crc = w1_calc_crc8(rom, 8);
|
||||
|
||||
if (rom[8] == crc && rom[0])
|
||||
verdict = 1;
|
||||
|
||||
}
|
||||
}
|
||||
|
||||
if (!w1_therm_check_rom(rom))
|
||||
break;
|
||||
}
|
||||
|
||||
for (i = 0; i < 9; ++i)
|
||||
count += sprintf(buf + count, "%02x ", rom[i]);
|
||||
count += sprintf(buf + count, ": crc=%02x %s\n",
|
||||
crc, (verdict) ? "YES" : "NO");
|
||||
if (verdict)
|
||||
memcpy(sl->rom, rom, sizeof(sl->rom));
|
||||
else
|
||||
dev_warn(&dev->dev, "18S20 doesn't respond to CONVERT_TEMP.\n");
|
||||
|
||||
for (i = 0; i < 9; ++i)
|
||||
count += sprintf(buf + count, "%02x ", sl->rom[i]);
|
||||
|
||||
count += sprintf(buf + count, "t=%d\n", w1_convert_temp(rom));
|
||||
out:
|
||||
up(&dev->mutex);
|
||||
out_dec:
|
||||
smp_mb__before_atomic_inc();
|
||||
atomic_dec(&sl->refcnt);
|
||||
|
||||
return count;
|
||||
}
|
||||
|
||||
static struct w1_family w1_therm_family = {
|
||||
.fid = W1_FAMILY_THERM,
|
||||
.fops = &w1_therm_fops,
|
||||
};
|
||||
|
||||
static int __init w1_therm_init(void)
|
||||
{
|
||||
return w1_register_family(&w1_therm_family);
|
||||
}
|
||||
|
||||
static void __exit w1_therm_fini(void)
|
||||
{
|
||||
w1_unregister_family(&w1_therm_family);
|
||||
}
|
||||
|
||||
module_init(w1_therm_init);
|
||||
module_exit(w1_therm_fini);
|
||||
Loading…
Reference in a new issue