blob: a698b517e8634be7c6e6ab22303d9dbf6646a439 [file] [log] [blame]
Linus Torvalds1da177e2005-04-16 15:20:36 -07001/*
Evgeniy Polyakov77859252005-05-20 22:33:25 +04002 * w1.c
Linus Torvalds1da177e2005-04-16 15:20:36 -07003 *
4 * Copyright (c) 2004 Evgeniy Polyakov <johnpol@2ka.mipt.ru>
Evgeniy Polyakov77859252005-05-20 22:33:25 +04005 *
Linus Torvalds1da177e2005-04-16 15:20:36 -07006 *
7 * This program is free software; you can redistribute it and/or modify
8 * it under the terms of the GNU General Public License as published by
9 * the Free Software Foundation; either version 2 of the License, or
10 * (at your option) any later version.
11 *
12 * This program is distributed in the hope that it will be useful,
13 * but WITHOUT ANY WARRANTY; without even the implied warranty of
14 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
15 * GNU General Public License for more details.
16 *
17 * You should have received a copy of the GNU General Public License
18 * along with this program; if not, write to the Free Software
19 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
20 */
21
22#include <linux/delay.h>
23#include <linux/kernel.h>
24#include <linux/module.h>
25#include <linux/moduleparam.h>
26#include <linux/list.h>
27#include <linux/interrupt.h>
28#include <linux/spinlock.h>
29#include <linux/timer.h>
30#include <linux/device.h>
31#include <linux/slab.h>
32#include <linux/sched.h>
Evgeniy Polyakov674a3962006-02-20 11:15:37 +030033#include <linux/kthread.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070034
35#include <asm/atomic.h>
36
37#include "w1.h"
38#include "w1_io.h"
39#include "w1_log.h"
40#include "w1_int.h"
41#include "w1_family.h"
42#include "w1_netlink.h"
43
44MODULE_LICENSE("GPL");
45MODULE_AUTHOR("Evgeniy Polyakov <johnpol@2ka.mipt.ru>");
46MODULE_DESCRIPTION("Driver for 1-wire Dallas network protocol.");
47
48static int w1_timeout = 10;
Evgeniy Polyakov3aca6922005-08-11 17:27:50 +040049static int w1_control_timeout = 1;
Linus Torvalds1da177e2005-04-16 15:20:36 -070050int w1_max_slave_count = 10;
51int w1_max_slave_ttl = 10;
52
53module_param_named(timeout, w1_timeout, int, 0);
Evgeniy Polyakov3aca6922005-08-11 17:27:50 +040054module_param_named(control_timeout, w1_control_timeout, int, 0);
Linus Torvalds1da177e2005-04-16 15:20:36 -070055module_param_named(max_slave_count, w1_max_slave_count, int, 0);
56module_param_named(slave_ttl, w1_max_slave_ttl, int, 0);
57
58DEFINE_SPINLOCK(w1_mlock);
59LIST_HEAD(w1_masters);
60
Evgeniy Polyakov674a3962006-02-20 11:15:37 +030061static struct task_struct *w1_control_thread;
Linus Torvalds1da177e2005-04-16 15:20:36 -070062
63static int w1_master_match(struct device *dev, struct device_driver *drv)
64{
65 return 1;
66}
67
68static int w1_master_probe(struct device *dev)
69{
70 return -ENODEV;
71}
72
Linus Torvalds1da177e2005-04-16 15:20:36 -070073static void w1_master_release(struct device *dev)
74{
Evgeniy Polyakovdb2d0002005-08-11 17:27:49 +040075 struct w1_master *md = dev_to_w1_master(dev);
Evgeniy Polyakov3aca6922005-08-11 17:27:50 +040076
77 dev_dbg(dev, "%s: Releasing %s.\n", __func__, md->name);
78
Evgeniy Polyakov2d1f87a2005-10-14 15:59:11 -070079 dev_fini_netlink(md);
Evgeniy Polyakov3aca6922005-08-11 17:27:50 +040080 memset(md, 0, sizeof(struct w1_master) + sizeof(struct w1_bus_master));
81 kfree(md);
Linus Torvalds1da177e2005-04-16 15:20:36 -070082}
83
84static void w1_slave_release(struct device *dev)
85{
Evgeniy Polyakovdb2d0002005-08-11 17:27:49 +040086 struct w1_slave *sl = dev_to_w1_slave(dev);
Evgeniy Polyakov3aca6922005-08-11 17:27:50 +040087
88 dev_dbg(dev, "%s: Releasing %s.\n", __func__, sl->name);
89
90 while (atomic_read(&sl->refcnt)) {
91 dev_dbg(dev, "Waiting for %s to become free: refcnt=%d.\n",
92 sl->name, atomic_read(&sl->refcnt));
93 if (msleep_interruptible(1000))
94 flush_signals(current);
95 }
96
97 w1_family_put(sl->family);
98 sl->master->slave_count--;
99
100 complete(&sl->released);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700101}
102
Evgeniy Polyakovd2a4ef62005-08-11 17:27:50 +0400103static ssize_t w1_slave_read_name(struct device *dev, struct device_attribute *attr, char *buf)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700104{
Evgeniy Polyakov3aca6922005-08-11 17:27:50 +0400105 struct w1_slave *sl = dev_to_w1_slave(dev);
Evgeniy Polyakovd2a4ef62005-08-11 17:27:50 +0400106
Evgeniy Polyakov3aca6922005-08-11 17:27:50 +0400107 return sprintf(buf, "%s\n", sl->name);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700108}
109
Evgeniy Polyakovd2a4ef62005-08-11 17:27:50 +0400110static ssize_t w1_slave_read_id(struct kobject *kobj, char *buf, loff_t off, size_t count)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700111{
Evgeniy Polyakov3aca6922005-08-11 17:27:50 +0400112 struct w1_slave *sl = kobj_to_w1_slave(kobj);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700113
Evgeniy Polyakov3aca6922005-08-11 17:27:50 +0400114 atomic_inc(&sl->refcnt);
115 if (off > 8) {
116 count = 0;
Evgeniy Polyakovd2a4ef62005-08-11 17:27:50 +0400117 } else {
118 if (off + count > 8)
119 count = 8 - off;
Evgeniy Polyakov77859252005-05-20 22:33:25 +0400120
Evgeniy Polyakovd2a4ef62005-08-11 17:27:50 +0400121 memcpy(buf, (u8 *)&sl->reg_num, count);
122 }
123 atomic_dec(&sl->refcnt);
124
125 return count;
Evgeniy Polyakov3aca6922005-08-11 17:27:50 +0400126}
Evgeniy Polyakovd2a4ef62005-08-11 17:27:50 +0400127
128static struct device_attribute w1_slave_attr_name =
129 __ATTR(name, S_IRUGO, w1_slave_read_name, NULL);
130
131static struct bin_attribute w1_slave_attr_bin_id = {
132 .attr = {
133 .name = "id",
134 .mode = S_IRUGO,
135 .owner = THIS_MODULE,
136 },
137 .size = 8,
138 .read = w1_slave_read_id,
Evgeniy Polyakov77859252005-05-20 22:33:25 +0400139};
140
Evgeniy Polyakovd2a4ef62005-08-11 17:27:50 +0400141/* Default family */
142static struct w1_family w1_default_family;
143
Kay Sievers312c0042005-11-16 09:00:00 +0100144static int w1_uevent(struct device *dev, char **envp, int num_envp, char *buffer, int buffer_size);
Evgeniy Polyakov77859252005-05-20 22:33:25 +0400145
Linus Torvalds1da177e2005-04-16 15:20:36 -0700146static struct bus_type w1_bus_type = {
147 .name = "w1",
148 .match = w1_master_match,
Kay Sievers312c0042005-11-16 09:00:00 +0100149 .uevent = w1_uevent,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700150};
151
Evgeniy Polyakov7f772ed2005-08-11 13:20:07 +0400152struct device_driver w1_master_driver = {
153 .name = "w1_master_driver",
Linus Torvalds1da177e2005-04-16 15:20:36 -0700154 .bus = &w1_bus_type,
155 .probe = w1_master_probe,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700156};
157
Evgeniy Polyakov7f772ed2005-08-11 13:20:07 +0400158struct device w1_master_device = {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700159 .parent = NULL,
160 .bus = &w1_bus_type,
161 .bus_id = "w1 bus master",
Evgeniy Polyakov7f772ed2005-08-11 13:20:07 +0400162 .driver = &w1_master_driver,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700163 .release = &w1_master_release
164};
165
Adrian Bunka9fb1c72005-12-13 14:04:33 -0800166static struct device_driver w1_slave_driver = {
Evgeniy Polyakov7f772ed2005-08-11 13:20:07 +0400167 .name = "w1_slave_driver",
168 .bus = &w1_bus_type,
169};
170
Adrian Bunka9fb1c72005-12-13 14:04:33 -0800171#if 0
Evgeniy Polyakov7f772ed2005-08-11 13:20:07 +0400172struct device w1_slave_device = {
173 .parent = NULL,
174 .bus = &w1_bus_type,
175 .bus_id = "w1 bus slave",
176 .driver = &w1_slave_driver,
Evgeniy Polyakov3aca6922005-08-11 17:27:50 +0400177 .release = &w1_slave_release
Evgeniy Polyakov7f772ed2005-08-11 13:20:07 +0400178};
Adrian Bunka9fb1c72005-12-13 14:04:33 -0800179#endif /* 0 */
Evgeniy Polyakov7f772ed2005-08-11 13:20:07 +0400180
Yani Ioannou060b8842005-05-17 06:44:04 -0400181static ssize_t w1_master_attribute_show_name(struct device *dev, struct device_attribute *attr, char *buf)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700182{
Evgeniy Polyakovdb2d0002005-08-11 17:27:49 +0400183 struct w1_master *md = dev_to_w1_master(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700184 ssize_t count;
Evgeniy Polyakov77859252005-05-20 22:33:25 +0400185
Linus Torvalds1da177e2005-04-16 15:20:36 -0700186 if (down_interruptible (&md->mutex))
187 return -EBUSY;
188
189 count = sprintf(buf, "%s\n", md->name);
Evgeniy Polyakov77859252005-05-20 22:33:25 +0400190
Linus Torvalds1da177e2005-04-16 15:20:36 -0700191 up(&md->mutex);
192
193 return count;
194}
195
Evgeniy Polyakov2a9d0c12005-06-04 01:31:02 +0400196static ssize_t w1_master_attribute_store_search(struct device * dev,
197 struct device_attribute *attr,
198 const char * buf, size_t count)
199{
Evgeniy Polyakovdb2d0002005-08-11 17:27:49 +0400200 struct w1_master *md = dev_to_w1_master(dev);
Evgeniy Polyakov2a9d0c12005-06-04 01:31:02 +0400201
202 if (down_interruptible (&md->mutex))
203 return -EBUSY;
204
205 md->search_count = simple_strtol(buf, NULL, 0);
206
207 up(&md->mutex);
208
209 return count;
210}
211
212static ssize_t w1_master_attribute_show_search(struct device *dev,
213 struct device_attribute *attr,
214 char *buf)
215{
Evgeniy Polyakovdb2d0002005-08-11 17:27:49 +0400216 struct w1_master *md = dev_to_w1_master(dev);
Evgeniy Polyakov2a9d0c12005-06-04 01:31:02 +0400217 ssize_t count;
218
219 if (down_interruptible (&md->mutex))
220 return -EBUSY;
221
222 count = sprintf(buf, "%d\n", md->search_count);
223
224 up(&md->mutex);
225
226 return count;
227}
228
Yani Ioannou060b8842005-05-17 06:44:04 -0400229static ssize_t w1_master_attribute_show_pointer(struct device *dev, struct device_attribute *attr, char *buf)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700230{
Evgeniy Polyakovdb2d0002005-08-11 17:27:49 +0400231 struct w1_master *md = dev_to_w1_master(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700232 ssize_t count;
Evgeniy Polyakov77859252005-05-20 22:33:25 +0400233
Linus Torvalds1da177e2005-04-16 15:20:36 -0700234 if (down_interruptible(&md->mutex))
235 return -EBUSY;
236
237 count = sprintf(buf, "0x%p\n", md->bus_master);
Evgeniy Polyakov77859252005-05-20 22:33:25 +0400238
Linus Torvalds1da177e2005-04-16 15:20:36 -0700239 up(&md->mutex);
240 return count;
241}
242
Yani Ioannou060b8842005-05-17 06:44:04 -0400243static ssize_t w1_master_attribute_show_timeout(struct device *dev, struct device_attribute *attr, char *buf)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700244{
245 ssize_t count;
246 count = sprintf(buf, "%d\n", w1_timeout);
247 return count;
248}
249
Yani Ioannou060b8842005-05-17 06:44:04 -0400250static ssize_t w1_master_attribute_show_max_slave_count(struct device *dev, struct device_attribute *attr, char *buf)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700251{
Evgeniy Polyakovdb2d0002005-08-11 17:27:49 +0400252 struct w1_master *md = dev_to_w1_master(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700253 ssize_t count;
Evgeniy Polyakov77859252005-05-20 22:33:25 +0400254
Linus Torvalds1da177e2005-04-16 15:20:36 -0700255 if (down_interruptible(&md->mutex))
256 return -EBUSY;
257
258 count = sprintf(buf, "%d\n", md->max_slave_count);
Evgeniy Polyakov77859252005-05-20 22:33:25 +0400259
Linus Torvalds1da177e2005-04-16 15:20:36 -0700260 up(&md->mutex);
261 return count;
262}
263
Yani Ioannou060b8842005-05-17 06:44:04 -0400264static ssize_t w1_master_attribute_show_attempts(struct device *dev, struct device_attribute *attr, char *buf)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700265{
Evgeniy Polyakovdb2d0002005-08-11 17:27:49 +0400266 struct w1_master *md = dev_to_w1_master(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700267 ssize_t count;
Evgeniy Polyakov77859252005-05-20 22:33:25 +0400268
Linus Torvalds1da177e2005-04-16 15:20:36 -0700269 if (down_interruptible(&md->mutex))
270 return -EBUSY;
271
272 count = sprintf(buf, "%lu\n", md->attempts);
Evgeniy Polyakov77859252005-05-20 22:33:25 +0400273
Linus Torvalds1da177e2005-04-16 15:20:36 -0700274 up(&md->mutex);
275 return count;
276}
277
Yani Ioannou060b8842005-05-17 06:44:04 -0400278static ssize_t w1_master_attribute_show_slave_count(struct device *dev, struct device_attribute *attr, char *buf)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700279{
Evgeniy Polyakovdb2d0002005-08-11 17:27:49 +0400280 struct w1_master *md = dev_to_w1_master(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700281 ssize_t count;
Evgeniy Polyakov77859252005-05-20 22:33:25 +0400282
Linus Torvalds1da177e2005-04-16 15:20:36 -0700283 if (down_interruptible(&md->mutex))
284 return -EBUSY;
285
286 count = sprintf(buf, "%d\n", md->slave_count);
Evgeniy Polyakov77859252005-05-20 22:33:25 +0400287
Linus Torvalds1da177e2005-04-16 15:20:36 -0700288 up(&md->mutex);
289 return count;
290}
291
Yani Ioannou060b8842005-05-17 06:44:04 -0400292static ssize_t w1_master_attribute_show_slaves(struct device *dev, struct device_attribute *attr, char *buf)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700293{
Evgeniy Polyakovdb2d0002005-08-11 17:27:49 +0400294 struct w1_master *md = dev_to_w1_master(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700295 int c = PAGE_SIZE;
296
297 if (down_interruptible(&md->mutex))
298 return -EBUSY;
299
300 if (md->slave_count == 0)
301 c -= snprintf(buf + PAGE_SIZE - c, c, "not found.\n");
302 else {
303 struct list_head *ent, *n;
304 struct w1_slave *sl;
305
306 list_for_each_safe(ent, n, &md->slist) {
307 sl = list_entry(ent, struct w1_slave, w1_slave_entry);
308
Evgeniy Polyakov77859252005-05-20 22:33:25 +0400309 c -= snprintf(buf + PAGE_SIZE - c, c, "%s\n", sl->name);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700310 }
311 }
312
313 up(&md->mutex);
314
315 return PAGE_SIZE - c;
316}
317
Evgeniy Polyakov77859252005-05-20 22:33:25 +0400318#define W1_MASTER_ATTR_RO(_name, _mode) \
319 struct device_attribute w1_master_attribute_##_name = \
320 __ATTR(w1_master_##_name, _mode, \
321 w1_master_attribute_show_##_name, NULL)
322
Evgeniy Polyakov2a9d0c12005-06-04 01:31:02 +0400323#define W1_MASTER_ATTR_RW(_name, _mode) \
324 struct device_attribute w1_master_attribute_##_name = \
325 __ATTR(w1_master_##_name, _mode, \
326 w1_master_attribute_show_##_name, \
327 w1_master_attribute_store_##_name)
328
Evgeniy Polyakov77859252005-05-20 22:33:25 +0400329static W1_MASTER_ATTR_RO(name, S_IRUGO);
330static W1_MASTER_ATTR_RO(slaves, S_IRUGO);
331static W1_MASTER_ATTR_RO(slave_count, S_IRUGO);
332static W1_MASTER_ATTR_RO(max_slave_count, S_IRUGO);
333static W1_MASTER_ATTR_RO(attempts, S_IRUGO);
334static W1_MASTER_ATTR_RO(timeout, S_IRUGO);
335static W1_MASTER_ATTR_RO(pointer, S_IRUGO);
Evgeniy Polyakov2a9d0c12005-06-04 01:31:02 +0400336static W1_MASTER_ATTR_RW(search, S_IRUGO | S_IWUGO);
Evgeniy Polyakov77859252005-05-20 22:33:25 +0400337
338static struct attribute *w1_master_default_attrs[] = {
339 &w1_master_attribute_name.attr,
340 &w1_master_attribute_slaves.attr,
341 &w1_master_attribute_slave_count.attr,
342 &w1_master_attribute_max_slave_count.attr,
343 &w1_master_attribute_attempts.attr,
344 &w1_master_attribute_timeout.attr,
345 &w1_master_attribute_pointer.attr,
Evgeniy Polyakov2a9d0c12005-06-04 01:31:02 +0400346 &w1_master_attribute_search.attr,
Evgeniy Polyakov77859252005-05-20 22:33:25 +0400347 NULL
Linus Torvalds1da177e2005-04-16 15:20:36 -0700348};
349
Evgeniy Polyakov77859252005-05-20 22:33:25 +0400350static struct attribute_group w1_master_defattr_group = {
351 .attrs = w1_master_default_attrs,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700352};
353
Evgeniy Polyakov77859252005-05-20 22:33:25 +0400354int w1_create_master_attributes(struct w1_master *master)
355{
356 return sysfs_create_group(&master->dev.kobj, &w1_master_defattr_group);
357}
358
Adrian Bunka9fb1c72005-12-13 14:04:33 -0800359static void w1_destroy_master_attributes(struct w1_master *master)
Evgeniy Polyakov77859252005-05-20 22:33:25 +0400360{
361 sysfs_remove_group(&master->dev.kobj, &w1_master_defattr_group);
362}
363
Evgeniy Polyakov7f772ed2005-08-11 13:20:07 +0400364#ifdef CONFIG_HOTPLUG
Kay Sievers312c0042005-11-16 09:00:00 +0100365static int w1_uevent(struct device *dev, char **envp, int num_envp, char *buffer, int buffer_size)
Evgeniy Polyakov7f772ed2005-08-11 13:20:07 +0400366{
367 struct w1_master *md = NULL;
368 struct w1_slave *sl = NULL;
369 char *event_owner, *name;
370 int err, cur_index=0, cur_len=0;
371
372 if (dev->driver == &w1_master_driver) {
373 md = container_of(dev, struct w1_master, dev);
374 event_owner = "master";
375 name = md->name;
376 } else if (dev->driver == &w1_slave_driver) {
377 sl = container_of(dev, struct w1_slave, dev);
378 event_owner = "slave";
379 name = sl->name;
380 } else {
Kay Sievers312c0042005-11-16 09:00:00 +0100381 dev_dbg(dev, "Unknown event.\n");
Evgeniy Polyakov7f772ed2005-08-11 13:20:07 +0400382 return -EINVAL;
383 }
384
385 dev_dbg(dev, "Hotplug event for %s %s, bus_id=%s.\n", event_owner, name, dev->bus_id);
386
387 if (dev->driver != &w1_slave_driver || !sl)
388 return 0;
389
Andrew Mortonf73b5e72006-01-14 00:05:59 -0800390 err = add_uevent_var(envp, num_envp, &cur_index, buffer, buffer_size,
391 &cur_len, "W1_FID=%02X", sl->reg_num.family);
Evgeniy Polyakov7f772ed2005-08-11 13:20:07 +0400392 if (err)
393 return err;
394
Andrew Mortonf73b5e72006-01-14 00:05:59 -0800395 err = add_uevent_var(envp, num_envp, &cur_index, buffer, buffer_size,
396 &cur_len, "W1_SLAVE_ID=%024LX",
397 (unsigned long long)sl->reg_num.id);
Evgeniy Polyakov7f772ed2005-08-11 13:20:07 +0400398 if (err)
399 return err;
400
401 return 0;
402};
403#else
Kay Sievers312c0042005-11-16 09:00:00 +0100404static int w1_uevent(struct device *dev, char **envp, int num_envp, char *buffer, int buffer_size)
Evgeniy Polyakov7f772ed2005-08-11 13:20:07 +0400405{
406 return 0;
407}
408#endif
409
Linus Torvalds1da177e2005-04-16 15:20:36 -0700410static int __w1_attach_slave_device(struct w1_slave *sl)
411{
412 int err;
413
414 sl->dev.parent = &sl->master->dev;
Evgeniy Polyakov7f772ed2005-08-11 13:20:07 +0400415 sl->dev.driver = &w1_slave_driver;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700416 sl->dev.bus = &w1_bus_type;
417 sl->dev.release = &w1_slave_release;
418
419 snprintf(&sl->dev.bus_id[0], sizeof(sl->dev.bus_id),
Evgeniy Polyakov6b729862005-06-04 01:30:43 +0400420 "%02x-%012llx",
421 (unsigned int) sl->reg_num.family,
422 (unsigned long long) sl->reg_num.id);
423 snprintf(&sl->name[0], sizeof(sl->name),
424 "%02x-%012llx",
425 (unsigned int) sl->reg_num.family,
426 (unsigned long long) sl->reg_num.id);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700427
Evgeniy Polyakov3aca6922005-08-11 17:27:50 +0400428 dev_dbg(&sl->dev, "%s: registering %s as %p.\n", __func__, &sl->dev.bus_id[0]);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700429
430 err = device_register(&sl->dev);
431 if (err < 0) {
432 dev_err(&sl->dev,
Evgeniy Polyakov6b729862005-06-04 01:30:43 +0400433 "Device registration [%s] failed. err=%d\n",
434 sl->dev.bus_id, err);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700435 return err;
436 }
437
Evgeniy Polyakovd2a4ef62005-08-11 17:27:50 +0400438 /* Create "name" entry */
439 err = device_create_file(&sl->dev, &w1_slave_attr_name);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700440 if (err < 0) {
441 dev_err(&sl->dev,
Evgeniy Polyakov6b729862005-06-04 01:30:43 +0400442 "sysfs file creation for [%s] failed. err=%d\n",
443 sl->dev.bus_id, err);
Evgeniy Polyakovd2a4ef62005-08-11 17:27:50 +0400444 goto out_unreg;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700445 }
446
Evgeniy Polyakovd2a4ef62005-08-11 17:27:50 +0400447 /* Create "id" entry */
448 err = sysfs_create_bin_file(&sl->dev.kobj, &w1_slave_attr_bin_id);
449 if (err < 0) {
450 dev_err(&sl->dev,
451 "sysfs file creation for [%s] failed. err=%d\n",
452 sl->dev.bus_id, err);
453 goto out_rem1;
454 }
455
456 /* if the family driver needs to initialize something... */
457 if (sl->family->fops && sl->family->fops->add_slave &&
458 ((err = sl->family->fops->add_slave(sl)) < 0)) {
459 dev_err(&sl->dev,
460 "sysfs file creation for [%s] failed. err=%d\n",
461 sl->dev.bus_id, err);
462 goto out_rem2;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700463 }
464
465 list_add_tail(&sl->w1_slave_entry, &sl->master->slist);
466
467 return 0;
Evgeniy Polyakovd2a4ef62005-08-11 17:27:50 +0400468
469out_rem2:
470 sysfs_remove_bin_file(&sl->dev.kobj, &w1_slave_attr_bin_id);
471out_rem1:
472 device_remove_file(&sl->dev, &w1_slave_attr_name);
473out_unreg:
474 device_unregister(&sl->dev);
475 return err;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700476}
477
478static int w1_attach_slave_device(struct w1_master *dev, struct w1_reg_num *rn)
479{
480 struct w1_slave *sl;
481 struct w1_family *f;
482 int err;
483 struct w1_netlink_msg msg;
484
485 sl = kmalloc(sizeof(struct w1_slave), GFP_KERNEL);
486 if (!sl) {
487 dev_err(&dev->dev,
488 "%s: failed to allocate new slave device.\n",
489 __func__);
490 return -ENOMEM;
491 }
492
493 memset(sl, 0, sizeof(*sl));
494
495 sl->owner = THIS_MODULE;
496 sl->master = dev;
497 set_bit(W1_SLAVE_ACTIVE, (long *)&sl->flags);
498
499 memcpy(&sl->reg_num, rn, sizeof(sl->reg_num));
500 atomic_set(&sl->refcnt, 0);
Evgeniy Polyakov3aca6922005-08-11 17:27:50 +0400501 init_completion(&sl->released);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700502
503 spin_lock(&w1_flock);
504 f = w1_family_registered(rn->family);
505 if (!f) {
Evgeniy Polyakov99c5bfe2005-06-04 01:31:26 +0400506 f= &w1_default_family;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700507 dev_info(&dev->dev, "Family %x for %02x.%012llx.%02x is not registered.\n",
508 rn->family, rn->family,
509 (unsigned long long)rn->id, rn->crc);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700510 }
511 __w1_family_get(f);
512 spin_unlock(&w1_flock);
513
514 sl->family = f;
515
516
517 err = __w1_attach_slave_device(sl);
518 if (err < 0) {
519 dev_err(&dev->dev, "%s: Attaching %s failed.\n", __func__,
520 sl->name);
521 w1_family_put(sl->family);
522 kfree(sl);
523 return err;
524 }
525
526 sl->ttl = dev->slave_ttl;
527 dev->slave_count++;
528
529 memcpy(&msg.id.id, rn, sizeof(msg.id.id));
530 msg.type = W1_SLAVE_ADD;
531 w1_netlink_send(dev, &msg);
532
533 return 0;
534}
535
536static void w1_slave_detach(struct w1_slave *sl)
537{
538 struct w1_netlink_msg msg;
Evgeniy Polyakov77859252005-05-20 22:33:25 +0400539
Evgeniy Polyakov7c8f5702005-08-11 17:27:50 +0400540 dev_dbg(&sl->dev, "%s: detaching %s [%p].\n", __func__, sl->name, sl);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700541
Evgeniy Polyakov3aca6922005-08-11 17:27:50 +0400542 list_del(&sl->w1_slave_entry);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700543
Evgeniy Polyakovd2a4ef62005-08-11 17:27:50 +0400544 if (sl->family->fops && sl->family->fops->remove_slave)
545 sl->family->fops->remove_slave(sl);
546
Linus Torvalds1da177e2005-04-16 15:20:36 -0700547 memcpy(&msg.id.id, &sl->reg_num, sizeof(msg.id.id));
548 msg.type = W1_SLAVE_REMOVE;
549 w1_netlink_send(sl->master, &msg);
Evgeniy Polyakov3aca6922005-08-11 17:27:50 +0400550
551 sysfs_remove_bin_file(&sl->dev.kobj, &w1_slave_attr_bin_id);
552 device_remove_file(&sl->dev, &w1_slave_attr_name);
553 device_unregister(&sl->dev);
554
555 wait_for_completion(&sl->released);
556 kfree(sl);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700557}
558
Evgeniy Polyakovccd69942005-12-06 13:38:27 +0300559static struct w1_master *w1_search_master(void *data)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700560{
561 struct w1_master *dev;
562 int found = 0;
Evgeniy Polyakov77859252005-05-20 22:33:25 +0400563
564 spin_lock_bh(&w1_mlock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700565 list_for_each_entry(dev, &w1_masters, w1_master_entry) {
566 if (dev->bus_master->data == data) {
567 found = 1;
568 atomic_inc(&dev->refcnt);
569 break;
570 }
571 }
Evgeniy Polyakov77859252005-05-20 22:33:25 +0400572 spin_unlock_bh(&w1_mlock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700573
574 return (found)?dev:NULL;
575}
576
Evgeniy Polyakov6adf87b2005-06-04 01:29:25 +0400577void w1_reconnect_slaves(struct w1_family *f)
578{
579 struct w1_master *dev;
580
581 spin_lock_bh(&w1_mlock);
582 list_for_each_entry(dev, &w1_masters, w1_master_entry) {
Evgeniy Polyakov7c8f5702005-08-11 17:27:50 +0400583 dev_dbg(&dev->dev, "Reconnecting slaves in %s into new family %02x.\n",
Evgeniy Polyakov6adf87b2005-06-04 01:29:25 +0400584 dev->name, f->fid);
585 set_bit(W1_MASTER_NEED_RECONNECT, &dev->flags);
586 }
587 spin_unlock_bh(&w1_mlock);
588}
589
Evgeniy Polyakovccd69942005-12-06 13:38:27 +0300590static void w1_slave_found(void *data, u64 rn)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700591{
592 int slave_count;
593 struct w1_slave *sl;
594 struct list_head *ent;
595 struct w1_reg_num *tmp;
596 int family_found = 0;
597 struct w1_master *dev;
Evgeniy Polyakov0e65f822005-06-30 22:52:38 +0400598 u64 rn_le = cpu_to_le64(rn);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700599
600 dev = w1_search_master(data);
601 if (!dev) {
Evgeniy Polyakovccd69942005-12-06 13:38:27 +0300602 printk(KERN_ERR "Failed to find w1 master device for data %p, "
603 "it is impossible.\n", data);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700604 return;
605 }
Evgeniy Polyakov77859252005-05-20 22:33:25 +0400606
Linus Torvalds1da177e2005-04-16 15:20:36 -0700607 tmp = (struct w1_reg_num *) &rn;
608
609 slave_count = 0;
610 list_for_each(ent, &dev->slist) {
611
612 sl = list_entry(ent, struct w1_slave, w1_slave_entry);
613
614 if (sl->reg_num.family == tmp->family &&
615 sl->reg_num.id == tmp->id &&
616 sl->reg_num.crc == tmp->crc) {
617 set_bit(W1_SLAVE_ACTIVE, (long *)&sl->flags);
618 break;
Evgeniy Polyakov77859252005-05-20 22:33:25 +0400619 } else if (sl->reg_num.family == tmp->family) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700620 family_found = 1;
621 break;
622 }
623
624 slave_count++;
625 }
626
johnpol@2ka.mipt.ru8523ff42005-04-18 21:16:57 -0700627 if (slave_count == dev->slave_count &&
Evgeniy Polyakov0e65f822005-06-30 22:52:38 +0400628 rn && ((rn >> 56) & 0xff) == w1_calc_crc8((u8 *)&rn_le, 7)) {
johnpol@2ka.mipt.ru8523ff42005-04-18 21:16:57 -0700629 w1_attach_slave_device(dev, tmp);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700630 }
Evgeniy Polyakov77859252005-05-20 22:33:25 +0400631
Linus Torvalds1da177e2005-04-16 15:20:36 -0700632 atomic_dec(&dev->refcnt);
633}
634
Evgeniy Polyakov6b729862005-06-04 01:30:43 +0400635/**
636 * Performs a ROM Search & registers any devices found.
637 * The 1-wire search is a simple binary tree search.
638 * For each bit of the address, we read two bits and write one bit.
639 * The bit written will put to sleep all devies that don't match that bit.
640 * When the two reads differ, the direction choice is obvious.
641 * When both bits are 0, we must choose a path to take.
642 * When we can scan all 64 bits without having to choose a path, we are done.
643 *
644 * See "Application note 187 1-wire search algorithm" at www.maxim-ic.com
645 *
646 * @dev The master device to search
647 * @cb Function to call when a device is found
648 */
649void w1_search(struct w1_master *dev, w1_slave_found_callback cb)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700650{
Evgeniy Polyakov6b729862005-06-04 01:30:43 +0400651 u64 last_rn, rn, tmp64;
652 int i, slave_count = 0;
653 int last_zero, last_device;
654 int search_bit, desc_bit;
655 u8 triplet_ret = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700656
Evgeniy Polyakov6b729862005-06-04 01:30:43 +0400657 search_bit = 0;
658 rn = last_rn = 0;
659 last_device = 0;
660 last_zero = -1;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700661
662 desc_bit = 64;
663
Evgeniy Polyakov6b729862005-06-04 01:30:43 +0400664 while ( !last_device && (slave_count++ < dev->max_slave_count) ) {
665 last_rn = rn;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700666 rn = 0;
667
Linus Torvalds1da177e2005-04-16 15:20:36 -0700668 /*
669 * Reset bus and all 1-wire device state machines
670 * so they can respond to our requests.
671 *
672 * Return 0 - device(s) present, 1 - no devices present.
673 */
674 if (w1_reset_bus(dev)) {
Evgeniy Polyakov2da5bf82005-08-12 11:46:22 -0700675 dev_dbg(&dev->dev, "No devices present on the wire.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700676 break;
677 }
678
Evgeniy Polyakov6b729862005-06-04 01:30:43 +0400679 /* Start the search */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700680 w1_write_8(dev, W1_SEARCH);
681 for (i = 0; i < 64; ++i) {
Evgeniy Polyakov6b729862005-06-04 01:30:43 +0400682 /* Determine the direction/search bit */
683 if (i == desc_bit)
684 search_bit = 1; /* took the 0 path last time, so take the 1 path */
685 else if (i > desc_bit)
686 search_bit = 0; /* take the 0 path on the next branch */
687 else
688 search_bit = ((last_rn >> i) & 0x1);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700689
Evgeniy Polyakov6b729862005-06-04 01:30:43 +0400690 /** Read two bits and write one bit */
691 triplet_ret = w1_triplet(dev, search_bit);
692
693 /* quit if no device responded */
694 if ( (triplet_ret & 0x03) == 0x03 )
Linus Torvalds1da177e2005-04-16 15:20:36 -0700695 break;
696
Evgeniy Polyakov6b729862005-06-04 01:30:43 +0400697 /* If both directions were valid, and we took the 0 path... */
698 if (triplet_ret == 0)
699 last_zero = i;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700700
Evgeniy Polyakov6b729862005-06-04 01:30:43 +0400701 /* extract the direction taken & update the device number */
702 tmp64 = (triplet_ret >> 2);
703 rn |= (tmp64 << i);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700704 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700705
Evgeniy Polyakov6b729862005-06-04 01:30:43 +0400706 if ( (triplet_ret & 0x03) != 0x03 ) {
707 if ( (desc_bit == last_zero) || (last_zero < 0))
708 last_device = 1;
709 desc_bit = last_zero;
710 cb(dev->bus_master->data, rn);
711 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700712 }
713}
714
Evgeniy Polyakov77859252005-05-20 22:33:25 +0400715static int w1_control(void *data)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700716{
Evgeniy Polyakov77859252005-05-20 22:33:25 +0400717 struct w1_slave *sl, *sln;
718 struct w1_master *dev, *n;
Evgeniy Polyakov674a3962006-02-20 11:15:37 +0300719 int have_to_wait = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700720
Evgeniy Polyakov674a3962006-02-20 11:15:37 +0300721 while (!kthread_should_stop() || have_to_wait) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700722 have_to_wait = 0;
723
Christoph Lameter3e1d1d22005-06-24 23:13:50 -0700724 try_to_freeze();
Evgeniy Polyakov3aca6922005-08-11 17:27:50 +0400725 msleep_interruptible(w1_control_timeout * 1000);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700726
Evgeniy Polyakov77859252005-05-20 22:33:25 +0400727 list_for_each_entry_safe(dev, n, &w1_masters, w1_master_entry) {
Evgeniy Polyakov674a3962006-02-20 11:15:37 +0300728 if (!kthread_should_stop() && !dev->flags)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700729 continue;
730 /*
731 * Little race: we can create thread but not set the flag.
732 * Get a chance for external process to set flag up.
733 */
734 if (!dev->initialized) {
735 have_to_wait = 1;
736 continue;
737 }
738
Evgeniy Polyakov674a3962006-02-20 11:15:37 +0300739 if (kthread_should_stop() || test_bit(W1_MASTER_NEED_EXIT, &dev->flags)) {
Evgeniy Polyakov6adf87b2005-06-04 01:29:25 +0400740 set_bit(W1_MASTER_NEED_EXIT, &dev->flags);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700741
Evgeniy Polyakov674a3962006-02-20 11:15:37 +0300742 spin_lock(&w1_mlock);
Evgeniy Polyakov6adf87b2005-06-04 01:29:25 +0400743 list_del(&dev->w1_master_entry);
Evgeniy Polyakov674a3962006-02-20 11:15:37 +0300744 spin_unlock(&w1_mlock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700745
Evgeniy Polyakov3aca6922005-08-11 17:27:50 +0400746 down(&dev->mutex);
Evgeniy Polyakov6adf87b2005-06-04 01:29:25 +0400747 list_for_each_entry_safe(sl, sln, &dev->slist, w1_slave_entry) {
Evgeniy Polyakov6adf87b2005-06-04 01:29:25 +0400748 w1_slave_detach(sl);
Evgeniy Polyakov6adf87b2005-06-04 01:29:25 +0400749 }
750 w1_destroy_master_attributes(dev);
Evgeniy Polyakov3aca6922005-08-11 17:27:50 +0400751 up(&dev->mutex);
Evgeniy Polyakov6adf87b2005-06-04 01:29:25 +0400752 atomic_dec(&dev->refcnt);
753 continue;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700754 }
Evgeniy Polyakov6adf87b2005-06-04 01:29:25 +0400755
756 if (test_bit(W1_MASTER_NEED_RECONNECT, &dev->flags)) {
Evgeniy Polyakov7c8f5702005-08-11 17:27:50 +0400757 dev_dbg(&dev->dev, "Reconnecting slaves in device %s.\n", dev->name);
Evgeniy Polyakov6adf87b2005-06-04 01:29:25 +0400758 down(&dev->mutex);
Evgeniy Polyakov3aca6922005-08-11 17:27:50 +0400759 list_for_each_entry_safe(sl, sln, &dev->slist, w1_slave_entry) {
Evgeniy Polyakov6adf87b2005-06-04 01:29:25 +0400760 if (sl->family->fid == W1_FAMILY_DEFAULT) {
761 struct w1_reg_num rn;
Evgeniy Polyakov6adf87b2005-06-04 01:29:25 +0400762
763 memcpy(&rn, &sl->reg_num, sizeof(rn));
Evgeniy Polyakov3aca6922005-08-11 17:27:50 +0400764 w1_slave_detach(sl);
Evgeniy Polyakov6adf87b2005-06-04 01:29:25 +0400765
766 w1_attach_slave_device(dev, &rn);
767 }
768 }
Evgeniy Polyakov7c8f5702005-08-11 17:27:50 +0400769 dev_dbg(&dev->dev, "Reconnecting slaves in device %s has been finished.\n", dev->name);
Evgeniy Polyakov6adf87b2005-06-04 01:29:25 +0400770 clear_bit(W1_MASTER_NEED_RECONNECT, &dev->flags);
771 up(&dev->mutex);
772 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700773 }
774 }
775
Evgeniy Polyakov674a3962006-02-20 11:15:37 +0300776 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700777}
778
779int w1_process(void *data)
780{
781 struct w1_master *dev = (struct w1_master *) data;
Evgeniy Polyakov77859252005-05-20 22:33:25 +0400782 struct w1_slave *sl, *sln;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700783
Evgeniy Polyakov674a3962006-02-20 11:15:37 +0300784 while (!kthread_should_stop() && !test_bit(W1_MASTER_NEED_EXIT, &dev->flags)) {
Christoph Lameter3e1d1d22005-06-24 23:13:50 -0700785 try_to_freeze();
Linus Torvalds1da177e2005-04-16 15:20:36 -0700786 msleep_interruptible(w1_timeout * 1000);
787
Evgeniy Polyakov674a3962006-02-20 11:15:37 +0300788 if (kthread_should_stop() || test_bit(W1_MASTER_NEED_EXIT, &dev->flags))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700789 break;
790
791 if (!dev->initialized)
792 continue;
793
Evgeniy Polyakov2a9d0c12005-06-04 01:31:02 +0400794 if (dev->search_count == 0)
795 continue;
796
Linus Torvalds1da177e2005-04-16 15:20:36 -0700797 if (down_interruptible(&dev->mutex))
798 continue;
799
Evgeniy Polyakov77859252005-05-20 22:33:25 +0400800 list_for_each_entry(sl, &dev->slist, w1_slave_entry)
Evgeniy Polyakov2a9d0c12005-06-04 01:31:02 +0400801 clear_bit(W1_SLAVE_ACTIVE, (long *)&sl->flags);
Evgeniy Polyakov77859252005-05-20 22:33:25 +0400802
Linus Torvalds1da177e2005-04-16 15:20:36 -0700803 w1_search_devices(dev, w1_slave_found);
804
Evgeniy Polyakov77859252005-05-20 22:33:25 +0400805 list_for_each_entry_safe(sl, sln, &dev->slist, w1_slave_entry) {
806 if (!test_bit(W1_SLAVE_ACTIVE, (unsigned long *)&sl->flags) && !--sl->ttl) {
Evgeniy Polyakovd2a4ef62005-08-11 17:27:50 +0400807 w1_slave_detach(sl);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700808
809 dev->slave_count--;
Evgeniy Polyakov77859252005-05-20 22:33:25 +0400810 } else if (test_bit(W1_SLAVE_ACTIVE, (unsigned long *)&sl->flags))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700811 sl->ttl = dev->slave_ttl;
812 }
Evgeniy Polyakov2a9d0c12005-06-04 01:31:02 +0400813
814 if (dev->search_count > 0)
815 dev->search_count--;
816
Linus Torvalds1da177e2005-04-16 15:20:36 -0700817 up(&dev->mutex);
818 }
819
820 atomic_dec(&dev->refcnt);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700821
822 return 0;
823}
824
Evgeniy Polyakov77859252005-05-20 22:33:25 +0400825static int w1_init(void)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700826{
827 int retval;
828
829 printk(KERN_INFO "Driver for 1-wire Dallas network protocol.\n");
830
831 retval = bus_register(&w1_bus_type);
832 if (retval) {
833 printk(KERN_ERR "Failed to register bus. err=%d.\n", retval);
834 goto err_out_exit_init;
835 }
836
Evgeniy Polyakov7f772ed2005-08-11 13:20:07 +0400837 retval = driver_register(&w1_master_driver);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700838 if (retval) {
839 printk(KERN_ERR
840 "Failed to register master driver. err=%d.\n",
841 retval);
842 goto err_out_bus_unregister;
843 }
844
Evgeniy Polyakov7f772ed2005-08-11 13:20:07 +0400845 retval = driver_register(&w1_slave_driver);
846 if (retval) {
847 printk(KERN_ERR
848 "Failed to register master driver. err=%d.\n",
849 retval);
850 goto err_out_master_unregister;
851 }
852
Evgeniy Polyakov674a3962006-02-20 11:15:37 +0300853 w1_control_thread = kthread_run(w1_control, NULL, "w1_control");
854 if (IS_ERR(w1_control_thread)) {
855 retval = PTR_ERR(w1_control_thread);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700856 printk(KERN_ERR "Failed to create control thread. err=%d\n",
Evgeniy Polyakov674a3962006-02-20 11:15:37 +0300857 retval);
Evgeniy Polyakov7f772ed2005-08-11 13:20:07 +0400858 goto err_out_slave_unregister;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700859 }
860
861 return 0;
862
Evgeniy Polyakov7f772ed2005-08-11 13:20:07 +0400863err_out_slave_unregister:
864 driver_unregister(&w1_slave_driver);
865
866err_out_master_unregister:
867 driver_unregister(&w1_master_driver);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700868
869err_out_bus_unregister:
870 bus_unregister(&w1_bus_type);
871
872err_out_exit_init:
873 return retval;
874}
875
Evgeniy Polyakov77859252005-05-20 22:33:25 +0400876static void w1_fini(void)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700877{
878 struct w1_master *dev;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700879
Evgeniy Polyakov77859252005-05-20 22:33:25 +0400880 list_for_each_entry(dev, &w1_masters, w1_master_entry)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700881 __w1_remove_master_device(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700882
Evgeniy Polyakov674a3962006-02-20 11:15:37 +0300883 kthread_stop(w1_control_thread);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700884
Evgeniy Polyakov7f772ed2005-08-11 13:20:07 +0400885 driver_unregister(&w1_slave_driver);
886 driver_unregister(&w1_master_driver);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700887 bus_unregister(&w1_bus_type);
888}
889
890module_init(w1_init);
891module_exit(w1_fini);