blob: 7d6876dbcc96a6dcf5cb85f12eb3a10045e52123 [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 Polyakov674a396c2006-02-20 11:15:37 +030033#include <linux/kthread.h>
Nigel Cunningham7dfb7102006-12-06 20:34:23 -080034#include <linux/freezer.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070035
36#include <asm/atomic.h>
37
38#include "w1.h"
Linus Torvalds1da177e2005-04-16 15:20:36 -070039#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
Evgeniy Polyakovabd52a12006-04-03 12:04:27 +040058DEFINE_MUTEX(w1_mlock);
Linus Torvalds1da177e2005-04-16 15:20:36 -070059LIST_HEAD(w1_masters);
60
Evgeniy Polyakov674a396c2006-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);
Evgeniy Polyakov3aca6922005-08-11 17:27:50 +040078 memset(md, 0, sizeof(struct w1_master) + sizeof(struct w1_bus_master));
79 kfree(md);
Linus Torvalds1da177e2005-04-16 15:20:36 -070080}
81
82static void w1_slave_release(struct device *dev)
83{
Evgeniy Polyakovdb2d0002005-08-11 17:27:49 +040084 struct w1_slave *sl = dev_to_w1_slave(dev);
Evgeniy Polyakov3aca6922005-08-11 17:27:50 +040085
Evgeniy Polyakov12003372006-03-23 19:11:58 +030086 printk("%s: Releasing %s.\n", __func__, sl->name);
Evgeniy Polyakov3aca6922005-08-11 17:27:50 +040087
88 while (atomic_read(&sl->refcnt)) {
Evgeniy Polyakov12003372006-03-23 19:11:58 +030089 printk("Waiting for %s to become free: refcnt=%d.\n",
Evgeniy Polyakov3aca6922005-08-11 17:27:50 +040090 sl->name, atomic_read(&sl->refcnt));
91 if (msleep_interruptible(1000))
92 flush_signals(current);
93 }
94
95 w1_family_put(sl->family);
96 sl->master->slave_count--;
97
98 complete(&sl->released);
Linus Torvalds1da177e2005-04-16 15:20:36 -070099}
100
Evgeniy Polyakovd2a4ef62005-08-11 17:27:50 +0400101static ssize_t w1_slave_read_name(struct device *dev, struct device_attribute *attr, char *buf)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700102{
Evgeniy Polyakov3aca6922005-08-11 17:27:50 +0400103 struct w1_slave *sl = dev_to_w1_slave(dev);
Evgeniy Polyakovd2a4ef62005-08-11 17:27:50 +0400104
Evgeniy Polyakov3aca6922005-08-11 17:27:50 +0400105 return sprintf(buf, "%s\n", sl->name);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700106}
107
Evgeniy Polyakovd2a4ef62005-08-11 17:27:50 +0400108static ssize_t w1_slave_read_id(struct kobject *kobj, char *buf, loff_t off, size_t count)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700109{
Evgeniy Polyakov3aca6922005-08-11 17:27:50 +0400110 struct w1_slave *sl = kobj_to_w1_slave(kobj);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700111
Evgeniy Polyakov3aca6922005-08-11 17:27:50 +0400112 if (off > 8) {
113 count = 0;
Evgeniy Polyakovd2a4ef62005-08-11 17:27:50 +0400114 } else {
115 if (off + count > 8)
116 count = 8 - off;
Evgeniy Polyakov77859252005-05-20 22:33:25 +0400117
Evgeniy Polyakovd2a4ef62005-08-11 17:27:50 +0400118 memcpy(buf, (u8 *)&sl->reg_num, count);
119 }
Evgeniy Polyakovd2a4ef62005-08-11 17:27:50 +0400120
121 return count;
Evgeniy Polyakov3aca6922005-08-11 17:27:50 +0400122}
Evgeniy Polyakovd2a4ef62005-08-11 17:27:50 +0400123
124static struct device_attribute w1_slave_attr_name =
125 __ATTR(name, S_IRUGO, w1_slave_read_name, NULL);
126
127static struct bin_attribute w1_slave_attr_bin_id = {
128 .attr = {
129 .name = "id",
130 .mode = S_IRUGO,
131 .owner = THIS_MODULE,
132 },
133 .size = 8,
134 .read = w1_slave_read_id,
Evgeniy Polyakov77859252005-05-20 22:33:25 +0400135};
136
Evgeniy Polyakovd2a4ef62005-08-11 17:27:50 +0400137/* Default family */
Evgeniy Polyakovf522d232006-03-23 19:11:58 +0300138
139static ssize_t w1_default_write(struct kobject *kobj, char *buf, loff_t off, size_t count)
140{
141 struct w1_slave *sl = kobj_to_w1_slave(kobj);
142
Evgeniy Polyakovabd52a12006-04-03 12:04:27 +0400143 mutex_lock(&sl->master->mutex);
Evgeniy Polyakovf522d232006-03-23 19:11:58 +0300144 if (w1_reset_select_slave(sl)) {
145 count = 0;
146 goto out_up;
147 }
148
149 w1_write_block(sl->master, buf, count);
150
151out_up:
Evgeniy Polyakovabd52a12006-04-03 12:04:27 +0400152 mutex_unlock(&sl->master->mutex);
Evgeniy Polyakovf522d232006-03-23 19:11:58 +0300153 return count;
154}
155
156static ssize_t w1_default_read(struct kobject *kobj, char *buf, loff_t off, size_t count)
157{
158 struct w1_slave *sl = kobj_to_w1_slave(kobj);
159
Evgeniy Polyakovabd52a12006-04-03 12:04:27 +0400160 mutex_lock(&sl->master->mutex);
Evgeniy Polyakovf522d232006-03-23 19:11:58 +0300161 w1_read_block(sl->master, buf, count);
Evgeniy Polyakovabd52a12006-04-03 12:04:27 +0400162 mutex_unlock(&sl->master->mutex);
Evgeniy Polyakovf522d232006-03-23 19:11:58 +0300163 return count;
164}
165
166static struct bin_attribute w1_default_attr = {
167 .attr = {
168 .name = "rw",
169 .mode = S_IRUGO | S_IWUSR,
170 .owner = THIS_MODULE,
171 },
172 .size = PAGE_SIZE,
173 .read = w1_default_read,
174 .write = w1_default_write,
175};
176
177static int w1_default_add_slave(struct w1_slave *sl)
178{
179 return sysfs_create_bin_file(&sl->dev.kobj, &w1_default_attr);
180}
181
182static void w1_default_remove_slave(struct w1_slave *sl)
183{
184 sysfs_remove_bin_file(&sl->dev.kobj, &w1_default_attr);
185}
186
187static struct w1_family_ops w1_default_fops = {
188 .add_slave = w1_default_add_slave,
189 .remove_slave = w1_default_remove_slave,
190};
191
192static struct w1_family w1_default_family = {
193 .fops = &w1_default_fops,
194};
Evgeniy Polyakovd2a4ef62005-08-11 17:27:50 +0400195
Kay Sievers312c0042005-11-16 09:00:00 +0100196static int w1_uevent(struct device *dev, char **envp, int num_envp, char *buffer, int buffer_size);
Evgeniy Polyakov77859252005-05-20 22:33:25 +0400197
Linus Torvalds1da177e2005-04-16 15:20:36 -0700198static struct bus_type w1_bus_type = {
199 .name = "w1",
200 .match = w1_master_match,
Kay Sievers312c0042005-11-16 09:00:00 +0100201 .uevent = w1_uevent,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700202};
203
Evgeniy Polyakov7f772ed2005-08-11 13:20:07 +0400204struct device_driver w1_master_driver = {
205 .name = "w1_master_driver",
Linus Torvalds1da177e2005-04-16 15:20:36 -0700206 .bus = &w1_bus_type,
207 .probe = w1_master_probe,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700208};
209
Evgeniy Polyakov7f772ed2005-08-11 13:20:07 +0400210struct device w1_master_device = {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700211 .parent = NULL,
212 .bus = &w1_bus_type,
213 .bus_id = "w1 bus master",
Evgeniy Polyakov7f772ed2005-08-11 13:20:07 +0400214 .driver = &w1_master_driver,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700215 .release = &w1_master_release
216};
217
Evgeniy Polyakov2c5bfda2006-04-04 20:35:22 +0400218static struct device_driver w1_slave_driver = {
Evgeniy Polyakov7f772ed2005-08-11 13:20:07 +0400219 .name = "w1_slave_driver",
220 .bus = &w1_bus_type,
221};
222
Evgeniy Polyakov2c5bfda2006-04-04 20:35:22 +0400223#if 0
Evgeniy Polyakov7f772ed2005-08-11 13:20:07 +0400224struct device w1_slave_device = {
225 .parent = NULL,
226 .bus = &w1_bus_type,
227 .bus_id = "w1 bus slave",
228 .driver = &w1_slave_driver,
Evgeniy Polyakov3aca6922005-08-11 17:27:50 +0400229 .release = &w1_slave_release
Evgeniy Polyakov7f772ed2005-08-11 13:20:07 +0400230};
Evgeniy Polyakov2c5bfda2006-04-04 20:35:22 +0400231#endif /* 0 */
Evgeniy Polyakov7f772ed2005-08-11 13:20:07 +0400232
Yani Ioannou060b8842005-05-17 06:44:04 -0400233static ssize_t w1_master_attribute_show_name(struct device *dev, struct device_attribute *attr, char *buf)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700234{
Evgeniy Polyakovdb2d0002005-08-11 17:27:49 +0400235 struct w1_master *md = dev_to_w1_master(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700236 ssize_t count;
Evgeniy Polyakov77859252005-05-20 22:33:25 +0400237
Evgeniy Polyakovabd52a12006-04-03 12:04:27 +0400238 mutex_lock(&md->mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700239 count = sprintf(buf, "%s\n", md->name);
Evgeniy Polyakovabd52a12006-04-03 12:04:27 +0400240 mutex_unlock(&md->mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700241
242 return count;
243}
244
Evgeniy Polyakov2a9d0c12005-06-04 01:31:02 +0400245static ssize_t w1_master_attribute_store_search(struct device * dev,
246 struct device_attribute *attr,
247 const char * buf, size_t count)
248{
Evgeniy Polyakovdb2d0002005-08-11 17:27:49 +0400249 struct w1_master *md = dev_to_w1_master(dev);
Evgeniy Polyakov2a9d0c12005-06-04 01:31:02 +0400250
Evgeniy Polyakovabd52a12006-04-03 12:04:27 +0400251 mutex_lock(&md->mutex);
Evgeniy Polyakov2a9d0c12005-06-04 01:31:02 +0400252 md->search_count = simple_strtol(buf, NULL, 0);
Evgeniy Polyakovabd52a12006-04-03 12:04:27 +0400253 mutex_unlock(&md->mutex);
Evgeniy Polyakov2a9d0c12005-06-04 01:31:02 +0400254
255 return count;
256}
257
258static ssize_t w1_master_attribute_show_search(struct device *dev,
259 struct device_attribute *attr,
260 char *buf)
261{
Evgeniy Polyakovdb2d0002005-08-11 17:27:49 +0400262 struct w1_master *md = dev_to_w1_master(dev);
Evgeniy Polyakov2a9d0c12005-06-04 01:31:02 +0400263 ssize_t count;
264
Evgeniy Polyakovabd52a12006-04-03 12:04:27 +0400265 mutex_lock(&md->mutex);
Evgeniy Polyakov2a9d0c12005-06-04 01:31:02 +0400266 count = sprintf(buf, "%d\n", md->search_count);
Evgeniy Polyakovabd52a12006-04-03 12:04:27 +0400267 mutex_unlock(&md->mutex);
Evgeniy Polyakov2a9d0c12005-06-04 01:31:02 +0400268
269 return count;
270}
271
Yani Ioannou060b8842005-05-17 06:44:04 -0400272static ssize_t w1_master_attribute_show_pointer(struct device *dev, struct device_attribute *attr, char *buf)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700273{
Evgeniy Polyakovdb2d0002005-08-11 17:27:49 +0400274 struct w1_master *md = dev_to_w1_master(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700275 ssize_t count;
Evgeniy Polyakov77859252005-05-20 22:33:25 +0400276
Evgeniy Polyakovabd52a12006-04-03 12:04:27 +0400277 mutex_lock(&md->mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700278 count = sprintf(buf, "0x%p\n", md->bus_master);
Evgeniy Polyakovabd52a12006-04-03 12:04:27 +0400279 mutex_unlock(&md->mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700280 return count;
281}
282
Yani Ioannou060b8842005-05-17 06:44:04 -0400283static ssize_t w1_master_attribute_show_timeout(struct device *dev, struct device_attribute *attr, char *buf)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700284{
285 ssize_t count;
286 count = sprintf(buf, "%d\n", w1_timeout);
287 return count;
288}
289
Yani Ioannou060b8842005-05-17 06:44:04 -0400290static 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 -0700291{
Evgeniy Polyakovdb2d0002005-08-11 17:27:49 +0400292 struct w1_master *md = dev_to_w1_master(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700293 ssize_t count;
Evgeniy Polyakov77859252005-05-20 22:33:25 +0400294
Evgeniy Polyakovabd52a12006-04-03 12:04:27 +0400295 mutex_lock(&md->mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700296 count = sprintf(buf, "%d\n", md->max_slave_count);
Evgeniy Polyakovabd52a12006-04-03 12:04:27 +0400297 mutex_unlock(&md->mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700298 return count;
299}
300
Yani Ioannou060b8842005-05-17 06:44:04 -0400301static ssize_t w1_master_attribute_show_attempts(struct device *dev, struct device_attribute *attr, char *buf)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700302{
Evgeniy Polyakovdb2d0002005-08-11 17:27:49 +0400303 struct w1_master *md = dev_to_w1_master(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700304 ssize_t count;
Evgeniy Polyakov77859252005-05-20 22:33:25 +0400305
Evgeniy Polyakovabd52a12006-04-03 12:04:27 +0400306 mutex_lock(&md->mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700307 count = sprintf(buf, "%lu\n", md->attempts);
Evgeniy Polyakovabd52a12006-04-03 12:04:27 +0400308 mutex_unlock(&md->mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700309 return count;
310}
311
Yani Ioannou060b8842005-05-17 06:44:04 -0400312static ssize_t w1_master_attribute_show_slave_count(struct device *dev, struct device_attribute *attr, char *buf)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700313{
Evgeniy Polyakovdb2d0002005-08-11 17:27:49 +0400314 struct w1_master *md = dev_to_w1_master(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700315 ssize_t count;
Evgeniy Polyakov77859252005-05-20 22:33:25 +0400316
Evgeniy Polyakovabd52a12006-04-03 12:04:27 +0400317 mutex_lock(&md->mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700318 count = sprintf(buf, "%d\n", md->slave_count);
Evgeniy Polyakovabd52a12006-04-03 12:04:27 +0400319 mutex_unlock(&md->mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700320 return count;
321}
322
Yani Ioannou060b8842005-05-17 06:44:04 -0400323static ssize_t w1_master_attribute_show_slaves(struct device *dev, struct device_attribute *attr, char *buf)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700324{
Evgeniy Polyakovdb2d0002005-08-11 17:27:49 +0400325 struct w1_master *md = dev_to_w1_master(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700326 int c = PAGE_SIZE;
327
Evgeniy Polyakovabd52a12006-04-03 12:04:27 +0400328 mutex_lock(&md->mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700329
330 if (md->slave_count == 0)
331 c -= snprintf(buf + PAGE_SIZE - c, c, "not found.\n");
332 else {
333 struct list_head *ent, *n;
334 struct w1_slave *sl;
335
336 list_for_each_safe(ent, n, &md->slist) {
337 sl = list_entry(ent, struct w1_slave, w1_slave_entry);
338
Evgeniy Polyakov77859252005-05-20 22:33:25 +0400339 c -= snprintf(buf + PAGE_SIZE - c, c, "%s\n", sl->name);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700340 }
341 }
342
Evgeniy Polyakovabd52a12006-04-03 12:04:27 +0400343 mutex_unlock(&md->mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700344
345 return PAGE_SIZE - c;
346}
347
Evgeniy Polyakov77859252005-05-20 22:33:25 +0400348#define W1_MASTER_ATTR_RO(_name, _mode) \
349 struct device_attribute w1_master_attribute_##_name = \
350 __ATTR(w1_master_##_name, _mode, \
351 w1_master_attribute_show_##_name, NULL)
352
Evgeniy Polyakov2a9d0c12005-06-04 01:31:02 +0400353#define W1_MASTER_ATTR_RW(_name, _mode) \
354 struct device_attribute w1_master_attribute_##_name = \
355 __ATTR(w1_master_##_name, _mode, \
356 w1_master_attribute_show_##_name, \
357 w1_master_attribute_store_##_name)
358
Evgeniy Polyakov77859252005-05-20 22:33:25 +0400359static W1_MASTER_ATTR_RO(name, S_IRUGO);
360static W1_MASTER_ATTR_RO(slaves, S_IRUGO);
361static W1_MASTER_ATTR_RO(slave_count, S_IRUGO);
362static W1_MASTER_ATTR_RO(max_slave_count, S_IRUGO);
363static W1_MASTER_ATTR_RO(attempts, S_IRUGO);
364static W1_MASTER_ATTR_RO(timeout, S_IRUGO);
365static W1_MASTER_ATTR_RO(pointer, S_IRUGO);
Evgeniy Polyakov2a9d0c12005-06-04 01:31:02 +0400366static W1_MASTER_ATTR_RW(search, S_IRUGO | S_IWUGO);
Evgeniy Polyakov77859252005-05-20 22:33:25 +0400367
368static struct attribute *w1_master_default_attrs[] = {
369 &w1_master_attribute_name.attr,
370 &w1_master_attribute_slaves.attr,
371 &w1_master_attribute_slave_count.attr,
372 &w1_master_attribute_max_slave_count.attr,
373 &w1_master_attribute_attempts.attr,
374 &w1_master_attribute_timeout.attr,
375 &w1_master_attribute_pointer.attr,
Evgeniy Polyakov2a9d0c12005-06-04 01:31:02 +0400376 &w1_master_attribute_search.attr,
Evgeniy Polyakov77859252005-05-20 22:33:25 +0400377 NULL
Linus Torvalds1da177e2005-04-16 15:20:36 -0700378};
379
Evgeniy Polyakov77859252005-05-20 22:33:25 +0400380static struct attribute_group w1_master_defattr_group = {
381 .attrs = w1_master_default_attrs,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700382};
383
Evgeniy Polyakov77859252005-05-20 22:33:25 +0400384int w1_create_master_attributes(struct w1_master *master)
385{
386 return sysfs_create_group(&master->dev.kobj, &w1_master_defattr_group);
387}
388
Evgeniy Polyakov2c5bfda2006-04-04 20:35:22 +0400389static void w1_destroy_master_attributes(struct w1_master *master)
Evgeniy Polyakov77859252005-05-20 22:33:25 +0400390{
391 sysfs_remove_group(&master->dev.kobj, &w1_master_defattr_group);
392}
393
Evgeniy Polyakov7f772ed2005-08-11 13:20:07 +0400394#ifdef CONFIG_HOTPLUG
Andrew Mortonc6976a42006-05-14 21:43:50 -0700395static int w1_uevent(struct device *dev, char **envp, int num_envp,
396 char *buffer, int buffer_size)
Evgeniy Polyakov7f772ed2005-08-11 13:20:07 +0400397{
398 struct w1_master *md = NULL;
399 struct w1_slave *sl = NULL;
400 char *event_owner, *name;
401 int err, cur_index=0, cur_len=0;
402
403 if (dev->driver == &w1_master_driver) {
404 md = container_of(dev, struct w1_master, dev);
405 event_owner = "master";
406 name = md->name;
407 } else if (dev->driver == &w1_slave_driver) {
408 sl = container_of(dev, struct w1_slave, dev);
409 event_owner = "slave";
410 name = sl->name;
411 } else {
Kay Sievers312c0042005-11-16 09:00:00 +0100412 dev_dbg(dev, "Unknown event.\n");
Evgeniy Polyakov7f772ed2005-08-11 13:20:07 +0400413 return -EINVAL;
414 }
415
Andrew Mortonc6976a42006-05-14 21:43:50 -0700416 dev_dbg(dev, "Hotplug event for %s %s, bus_id=%s.\n",
417 event_owner, name, dev->bus_id);
Evgeniy Polyakov7f772ed2005-08-11 13:20:07 +0400418
419 if (dev->driver != &w1_slave_driver || !sl)
420 return 0;
421
Andrew Mortonc6976a42006-05-14 21:43:50 -0700422 err = add_uevent_var(envp, num_envp, &cur_index, buffer, buffer_size,
423 &cur_len, "W1_FID=%02X", sl->reg_num.family);
Evgeniy Polyakov7f772ed2005-08-11 13:20:07 +0400424 if (err)
425 return err;
426
Andrew Mortonc6976a42006-05-14 21:43:50 -0700427 err = add_uevent_var(envp, num_envp, &cur_index, buffer, buffer_size,
428 &cur_len, "W1_SLAVE_ID=%024LX",
429 (unsigned long long)sl->reg_num.id);
Evgeniy Polyakov7f772ed2005-08-11 13:20:07 +0400430 if (err)
431 return err;
432
433 return 0;
434};
435#else
Andrew Mortonc6976a42006-05-14 21:43:50 -0700436static int w1_uevent(struct device *dev, char **envp, int num_envp,
437 char *buffer, int buffer_size)
Evgeniy Polyakov7f772ed2005-08-11 13:20:07 +0400438{
439 return 0;
440}
441#endif
442
Linus Torvalds1da177e2005-04-16 15:20:36 -0700443static int __w1_attach_slave_device(struct w1_slave *sl)
444{
445 int err;
446
447 sl->dev.parent = &sl->master->dev;
Evgeniy Polyakov7f772ed2005-08-11 13:20:07 +0400448 sl->dev.driver = &w1_slave_driver;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700449 sl->dev.bus = &w1_bus_type;
450 sl->dev.release = &w1_slave_release;
451
452 snprintf(&sl->dev.bus_id[0], sizeof(sl->dev.bus_id),
Evgeniy Polyakov6b729862005-06-04 01:30:43 +0400453 "%02x-%012llx",
454 (unsigned int) sl->reg_num.family,
455 (unsigned long long) sl->reg_num.id);
456 snprintf(&sl->name[0], sizeof(sl->name),
457 "%02x-%012llx",
458 (unsigned int) sl->reg_num.family,
459 (unsigned long long) sl->reg_num.id);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700460
Andrew Mortonc6976a42006-05-14 21:43:50 -0700461 dev_dbg(&sl->dev, "%s: registering %s as %p.\n", __func__,
Evgeniy Polyakov60ed34b2007-05-08 00:31:19 -0700462 &sl->dev.bus_id[0], sl);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700463
464 err = device_register(&sl->dev);
465 if (err < 0) {
466 dev_err(&sl->dev,
Evgeniy Polyakov6b729862005-06-04 01:30:43 +0400467 "Device registration [%s] failed. err=%d\n",
468 sl->dev.bus_id, err);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700469 return err;
470 }
471
Evgeniy Polyakovd2a4ef62005-08-11 17:27:50 +0400472 /* Create "name" entry */
473 err = device_create_file(&sl->dev, &w1_slave_attr_name);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700474 if (err < 0) {
475 dev_err(&sl->dev,
Evgeniy Polyakov6b729862005-06-04 01:30:43 +0400476 "sysfs file creation for [%s] failed. err=%d\n",
477 sl->dev.bus_id, err);
Evgeniy Polyakovd2a4ef62005-08-11 17:27:50 +0400478 goto out_unreg;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700479 }
480
Evgeniy Polyakovd2a4ef62005-08-11 17:27:50 +0400481 /* Create "id" entry */
482 err = sysfs_create_bin_file(&sl->dev.kobj, &w1_slave_attr_bin_id);
483 if (err < 0) {
484 dev_err(&sl->dev,
485 "sysfs file creation for [%s] failed. err=%d\n",
486 sl->dev.bus_id, err);
487 goto out_rem1;
488 }
489
490 /* if the family driver needs to initialize something... */
491 if (sl->family->fops && sl->family->fops->add_slave &&
492 ((err = sl->family->fops->add_slave(sl)) < 0)) {
493 dev_err(&sl->dev,
494 "sysfs file creation for [%s] failed. err=%d\n",
495 sl->dev.bus_id, err);
496 goto out_rem2;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700497 }
498
499 list_add_tail(&sl->w1_slave_entry, &sl->master->slist);
500
501 return 0;
Evgeniy Polyakovd2a4ef62005-08-11 17:27:50 +0400502
503out_rem2:
504 sysfs_remove_bin_file(&sl->dev.kobj, &w1_slave_attr_bin_id);
505out_rem1:
506 device_remove_file(&sl->dev, &w1_slave_attr_name);
507out_unreg:
508 device_unregister(&sl->dev);
509 return err;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700510}
511
512static int w1_attach_slave_device(struct w1_master *dev, struct w1_reg_num *rn)
513{
514 struct w1_slave *sl;
515 struct w1_family *f;
516 int err;
517 struct w1_netlink_msg msg;
518
519 sl = kmalloc(sizeof(struct w1_slave), GFP_KERNEL);
520 if (!sl) {
521 dev_err(&dev->dev,
522 "%s: failed to allocate new slave device.\n",
523 __func__);
524 return -ENOMEM;
525 }
526
527 memset(sl, 0, sizeof(*sl));
528
529 sl->owner = THIS_MODULE;
530 sl->master = dev;
531 set_bit(W1_SLAVE_ACTIVE, (long *)&sl->flags);
532
Evgeniy Polyakov12003372006-03-23 19:11:58 +0300533 memset(&msg, 0, sizeof(msg));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700534 memcpy(&sl->reg_num, rn, sizeof(sl->reg_num));
535 atomic_set(&sl->refcnt, 0);
Evgeniy Polyakov3aca6922005-08-11 17:27:50 +0400536 init_completion(&sl->released);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700537
538 spin_lock(&w1_flock);
539 f = w1_family_registered(rn->family);
540 if (!f) {
Evgeniy Polyakov99c5bfe2005-06-04 01:31:26 +0400541 f= &w1_default_family;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700542 dev_info(&dev->dev, "Family %x for %02x.%012llx.%02x is not registered.\n",
543 rn->family, rn->family,
544 (unsigned long long)rn->id, rn->crc);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700545 }
546 __w1_family_get(f);
547 spin_unlock(&w1_flock);
548
549 sl->family = f;
550
551
552 err = __w1_attach_slave_device(sl);
553 if (err < 0) {
554 dev_err(&dev->dev, "%s: Attaching %s failed.\n", __func__,
555 sl->name);
556 w1_family_put(sl->family);
557 kfree(sl);
558 return err;
559 }
560
561 sl->ttl = dev->slave_ttl;
562 dev->slave_count++;
563
Evgeniy Polyakov12003372006-03-23 19:11:58 +0300564 memcpy(msg.id.id, rn, sizeof(msg.id));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700565 msg.type = W1_SLAVE_ADD;
566 w1_netlink_send(dev, &msg);
567
568 return 0;
569}
570
571static void w1_slave_detach(struct w1_slave *sl)
572{
573 struct w1_netlink_msg msg;
Evgeniy Polyakov77859252005-05-20 22:33:25 +0400574
Evgeniy Polyakov7c8f5702005-08-11 17:27:50 +0400575 dev_dbg(&sl->dev, "%s: detaching %s [%p].\n", __func__, sl->name, sl);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700576
Evgeniy Polyakov3aca6922005-08-11 17:27:50 +0400577 list_del(&sl->w1_slave_entry);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700578
Evgeniy Polyakovd2a4ef62005-08-11 17:27:50 +0400579 if (sl->family->fops && sl->family->fops->remove_slave)
580 sl->family->fops->remove_slave(sl);
581
Evgeniy Polyakov12003372006-03-23 19:11:58 +0300582 memset(&msg, 0, sizeof(msg));
583 memcpy(msg.id.id, &sl->reg_num, sizeof(msg.id));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700584 msg.type = W1_SLAVE_REMOVE;
585 w1_netlink_send(sl->master, &msg);
Evgeniy Polyakov3aca6922005-08-11 17:27:50 +0400586
587 sysfs_remove_bin_file(&sl->dev.kobj, &w1_slave_attr_bin_id);
588 device_remove_file(&sl->dev, &w1_slave_attr_name);
589 device_unregister(&sl->dev);
590
591 wait_for_completion(&sl->released);
592 kfree(sl);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700593}
594
Evgeniy Polyakovccd69942005-12-06 13:38:27 +0300595static struct w1_master *w1_search_master(void *data)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700596{
597 struct w1_master *dev;
598 int found = 0;
Evgeniy Polyakov77859252005-05-20 22:33:25 +0400599
Evgeniy Polyakovabd52a12006-04-03 12:04:27 +0400600 mutex_lock(&w1_mlock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700601 list_for_each_entry(dev, &w1_masters, w1_master_entry) {
602 if (dev->bus_master->data == data) {
603 found = 1;
604 atomic_inc(&dev->refcnt);
605 break;
606 }
607 }
Evgeniy Polyakovabd52a12006-04-03 12:04:27 +0400608 mutex_unlock(&w1_mlock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700609
610 return (found)?dev:NULL;
611}
612
Evgeniy Polyakov12003372006-03-23 19:11:58 +0300613struct w1_master *w1_search_master_id(u32 id)
614{
615 struct w1_master *dev;
616 int found = 0;
617
Evgeniy Polyakovabd52a12006-04-03 12:04:27 +0400618 mutex_lock(&w1_mlock);
Evgeniy Polyakov12003372006-03-23 19:11:58 +0300619 list_for_each_entry(dev, &w1_masters, w1_master_entry) {
620 if (dev->id == id) {
621 found = 1;
622 atomic_inc(&dev->refcnt);
623 break;
624 }
625 }
Evgeniy Polyakovabd52a12006-04-03 12:04:27 +0400626 mutex_unlock(&w1_mlock);
Evgeniy Polyakov12003372006-03-23 19:11:58 +0300627
628 return (found)?dev:NULL;
629}
630
631struct w1_slave *w1_search_slave(struct w1_reg_num *id)
632{
633 struct w1_master *dev;
634 struct w1_slave *sl = NULL;
635 int found = 0;
636
Evgeniy Polyakovabd52a12006-04-03 12:04:27 +0400637 mutex_lock(&w1_mlock);
Evgeniy Polyakov12003372006-03-23 19:11:58 +0300638 list_for_each_entry(dev, &w1_masters, w1_master_entry) {
Evgeniy Polyakovabd52a12006-04-03 12:04:27 +0400639 mutex_lock(&dev->mutex);
Evgeniy Polyakov12003372006-03-23 19:11:58 +0300640 list_for_each_entry(sl, &dev->slist, w1_slave_entry) {
641 if (sl->reg_num.family == id->family &&
642 sl->reg_num.id == id->id &&
643 sl->reg_num.crc == id->crc) {
644 found = 1;
645 atomic_inc(&dev->refcnt);
646 atomic_inc(&sl->refcnt);
647 break;
648 }
649 }
Evgeniy Polyakovabd52a12006-04-03 12:04:27 +0400650 mutex_unlock(&dev->mutex);
Evgeniy Polyakov12003372006-03-23 19:11:58 +0300651
652 if (found)
653 break;
654 }
Evgeniy Polyakovabd52a12006-04-03 12:04:27 +0400655 mutex_unlock(&w1_mlock);
Evgeniy Polyakov12003372006-03-23 19:11:58 +0300656
657 return (found)?sl:NULL;
658}
659
Evgeniy Polyakov6adf87b2005-06-04 01:29:25 +0400660void w1_reconnect_slaves(struct w1_family *f)
661{
662 struct w1_master *dev;
663
Evgeniy Polyakovabd52a12006-04-03 12:04:27 +0400664 mutex_lock(&w1_mlock);
Evgeniy Polyakov6adf87b2005-06-04 01:29:25 +0400665 list_for_each_entry(dev, &w1_masters, w1_master_entry) {
Evgeniy Polyakov7c8f5702005-08-11 17:27:50 +0400666 dev_dbg(&dev->dev, "Reconnecting slaves in %s into new family %02x.\n",
Evgeniy Polyakov6adf87b2005-06-04 01:29:25 +0400667 dev->name, f->fid);
668 set_bit(W1_MASTER_NEED_RECONNECT, &dev->flags);
669 }
Evgeniy Polyakovabd52a12006-04-03 12:04:27 +0400670 mutex_unlock(&w1_mlock);
Evgeniy Polyakov6adf87b2005-06-04 01:29:25 +0400671}
672
Evgeniy Polyakovccd69942005-12-06 13:38:27 +0300673static void w1_slave_found(void *data, u64 rn)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700674{
675 int slave_count;
676 struct w1_slave *sl;
677 struct list_head *ent;
678 struct w1_reg_num *tmp;
679 int family_found = 0;
680 struct w1_master *dev;
Evgeniy Polyakov0e65f822005-06-30 22:52:38 +0400681 u64 rn_le = cpu_to_le64(rn);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700682
683 dev = w1_search_master(data);
684 if (!dev) {
Evgeniy Polyakovccd69942005-12-06 13:38:27 +0300685 printk(KERN_ERR "Failed to find w1 master device for data %p, "
686 "it is impossible.\n", data);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700687 return;
688 }
Evgeniy Polyakov77859252005-05-20 22:33:25 +0400689
Linus Torvalds1da177e2005-04-16 15:20:36 -0700690 tmp = (struct w1_reg_num *) &rn;
691
692 slave_count = 0;
693 list_for_each(ent, &dev->slist) {
694
695 sl = list_entry(ent, struct w1_slave, w1_slave_entry);
696
697 if (sl->reg_num.family == tmp->family &&
698 sl->reg_num.id == tmp->id &&
699 sl->reg_num.crc == tmp->crc) {
700 set_bit(W1_SLAVE_ACTIVE, (long *)&sl->flags);
701 break;
Evgeniy Polyakov77859252005-05-20 22:33:25 +0400702 } else if (sl->reg_num.family == tmp->family) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700703 family_found = 1;
704 break;
705 }
706
707 slave_count++;
708 }
709
johnpol@2ka.mipt.ru8523ff42005-04-18 21:16:57 -0700710 if (slave_count == dev->slave_count &&
Evgeniy Polyakov0e65f822005-06-30 22:52:38 +0400711 rn && ((rn >> 56) & 0xff) == w1_calc_crc8((u8 *)&rn_le, 7)) {
johnpol@2ka.mipt.ru8523ff42005-04-18 21:16:57 -0700712 w1_attach_slave_device(dev, tmp);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700713 }
Evgeniy Polyakov77859252005-05-20 22:33:25 +0400714
Linus Torvalds1da177e2005-04-16 15:20:36 -0700715 atomic_dec(&dev->refcnt);
716}
717
Evgeniy Polyakov6b729862005-06-04 01:30:43 +0400718/**
719 * Performs a ROM Search & registers any devices found.
720 * The 1-wire search is a simple binary tree search.
721 * For each bit of the address, we read two bits and write one bit.
722 * The bit written will put to sleep all devies that don't match that bit.
723 * When the two reads differ, the direction choice is obvious.
724 * When both bits are 0, we must choose a path to take.
725 * When we can scan all 64 bits without having to choose a path, we are done.
726 *
727 * See "Application note 187 1-wire search algorithm" at www.maxim-ic.com
728 *
729 * @dev The master device to search
730 * @cb Function to call when a device is found
731 */
Evgeniy Polyakov12003372006-03-23 19:11:58 +0300732void w1_search(struct w1_master *dev, u8 search_type, w1_slave_found_callback cb)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700733{
Evgeniy Polyakov6b729862005-06-04 01:30:43 +0400734 u64 last_rn, rn, tmp64;
735 int i, slave_count = 0;
736 int last_zero, last_device;
737 int search_bit, desc_bit;
738 u8 triplet_ret = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700739
Evgeniy Polyakov6b729862005-06-04 01:30:43 +0400740 search_bit = 0;
741 rn = last_rn = 0;
742 last_device = 0;
743 last_zero = -1;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700744
745 desc_bit = 64;
746
Evgeniy Polyakov6b729862005-06-04 01:30:43 +0400747 while ( !last_device && (slave_count++ < dev->max_slave_count) ) {
748 last_rn = rn;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700749 rn = 0;
750
Linus Torvalds1da177e2005-04-16 15:20:36 -0700751 /*
752 * Reset bus and all 1-wire device state machines
753 * so they can respond to our requests.
754 *
755 * Return 0 - device(s) present, 1 - no devices present.
756 */
757 if (w1_reset_bus(dev)) {
Evgeniy Polyakov2da5bf82005-08-12 11:46:22 -0700758 dev_dbg(&dev->dev, "No devices present on the wire.\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700759 break;
760 }
761
Evgeniy Polyakov6b729862005-06-04 01:30:43 +0400762 /* Start the search */
Evgeniy Polyakov12003372006-03-23 19:11:58 +0300763 w1_write_8(dev, search_type);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700764 for (i = 0; i < 64; ++i) {
Evgeniy Polyakov6b729862005-06-04 01:30:43 +0400765 /* Determine the direction/search bit */
766 if (i == desc_bit)
767 search_bit = 1; /* took the 0 path last time, so take the 1 path */
768 else if (i > desc_bit)
769 search_bit = 0; /* take the 0 path on the next branch */
770 else
771 search_bit = ((last_rn >> i) & 0x1);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700772
Evgeniy Polyakov6b729862005-06-04 01:30:43 +0400773 /** Read two bits and write one bit */
774 triplet_ret = w1_triplet(dev, search_bit);
775
776 /* quit if no device responded */
777 if ( (triplet_ret & 0x03) == 0x03 )
Linus Torvalds1da177e2005-04-16 15:20:36 -0700778 break;
779
Evgeniy Polyakov6b729862005-06-04 01:30:43 +0400780 /* If both directions were valid, and we took the 0 path... */
781 if (triplet_ret == 0)
782 last_zero = i;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700783
Evgeniy Polyakov6b729862005-06-04 01:30:43 +0400784 /* extract the direction taken & update the device number */
785 tmp64 = (triplet_ret >> 2);
786 rn |= (tmp64 << i);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700787 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700788
Evgeniy Polyakov6b729862005-06-04 01:30:43 +0400789 if ( (triplet_ret & 0x03) != 0x03 ) {
790 if ( (desc_bit == last_zero) || (last_zero < 0))
791 last_device = 1;
792 desc_bit = last_zero;
793 cb(dev->bus_master->data, rn);
794 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700795 }
796}
797
Evgeniy Polyakov77859252005-05-20 22:33:25 +0400798static int w1_control(void *data)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700799{
Evgeniy Polyakov77859252005-05-20 22:33:25 +0400800 struct w1_slave *sl, *sln;
801 struct w1_master *dev, *n;
Evgeniy Polyakov674a396c2006-02-20 11:15:37 +0300802 int have_to_wait = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700803
Evgeniy Polyakov674a396c2006-02-20 11:15:37 +0300804 while (!kthread_should_stop() || have_to_wait) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700805 have_to_wait = 0;
806
Christoph Lameter3e1d1d22005-06-24 23:13:50 -0700807 try_to_freeze();
Evgeniy Polyakov3aca6922005-08-11 17:27:50 +0400808 msleep_interruptible(w1_control_timeout * 1000);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700809
Evgeniy Polyakov77859252005-05-20 22:33:25 +0400810 list_for_each_entry_safe(dev, n, &w1_masters, w1_master_entry) {
Evgeniy Polyakov674a396c2006-02-20 11:15:37 +0300811 if (!kthread_should_stop() && !dev->flags)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700812 continue;
813 /*
814 * Little race: we can create thread but not set the flag.
815 * Get a chance for external process to set flag up.
816 */
817 if (!dev->initialized) {
818 have_to_wait = 1;
819 continue;
820 }
821
Evgeniy Polyakov674a396c2006-02-20 11:15:37 +0300822 if (kthread_should_stop() || test_bit(W1_MASTER_NEED_EXIT, &dev->flags)) {
Evgeniy Polyakov6adf87b2005-06-04 01:29:25 +0400823 set_bit(W1_MASTER_NEED_EXIT, &dev->flags);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700824
Evgeniy Polyakovabd52a12006-04-03 12:04:27 +0400825 mutex_lock(&w1_mlock);
Evgeniy Polyakov6adf87b2005-06-04 01:29:25 +0400826 list_del(&dev->w1_master_entry);
Evgeniy Polyakovabd52a12006-04-03 12:04:27 +0400827 mutex_unlock(&w1_mlock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700828
Evgeniy Polyakovabd52a12006-04-03 12:04:27 +0400829 mutex_lock(&dev->mutex);
Evgeniy Polyakov6adf87b2005-06-04 01:29:25 +0400830 list_for_each_entry_safe(sl, sln, &dev->slist, w1_slave_entry) {
Evgeniy Polyakov6adf87b2005-06-04 01:29:25 +0400831 w1_slave_detach(sl);
Evgeniy Polyakov6adf87b2005-06-04 01:29:25 +0400832 }
833 w1_destroy_master_attributes(dev);
Evgeniy Polyakovabd52a12006-04-03 12:04:27 +0400834 mutex_unlock(&dev->mutex);
Evgeniy Polyakov6adf87b2005-06-04 01:29:25 +0400835 atomic_dec(&dev->refcnt);
836 continue;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700837 }
Evgeniy Polyakov6adf87b2005-06-04 01:29:25 +0400838
839 if (test_bit(W1_MASTER_NEED_RECONNECT, &dev->flags)) {
Evgeniy Polyakov7c8f5702005-08-11 17:27:50 +0400840 dev_dbg(&dev->dev, "Reconnecting slaves in device %s.\n", dev->name);
Evgeniy Polyakovabd52a12006-04-03 12:04:27 +0400841 mutex_lock(&dev->mutex);
Evgeniy Polyakov3aca6922005-08-11 17:27:50 +0400842 list_for_each_entry_safe(sl, sln, &dev->slist, w1_slave_entry) {
Evgeniy Polyakov6adf87b2005-06-04 01:29:25 +0400843 if (sl->family->fid == W1_FAMILY_DEFAULT) {
844 struct w1_reg_num rn;
Evgeniy Polyakov6adf87b2005-06-04 01:29:25 +0400845
846 memcpy(&rn, &sl->reg_num, sizeof(rn));
Evgeniy Polyakov3aca6922005-08-11 17:27:50 +0400847 w1_slave_detach(sl);
Evgeniy Polyakov6adf87b2005-06-04 01:29:25 +0400848
849 w1_attach_slave_device(dev, &rn);
850 }
851 }
Evgeniy Polyakov7c8f5702005-08-11 17:27:50 +0400852 dev_dbg(&dev->dev, "Reconnecting slaves in device %s has been finished.\n", dev->name);
Evgeniy Polyakov6adf87b2005-06-04 01:29:25 +0400853 clear_bit(W1_MASTER_NEED_RECONNECT, &dev->flags);
Evgeniy Polyakovabd52a12006-04-03 12:04:27 +0400854 mutex_unlock(&dev->mutex);
Evgeniy Polyakov6adf87b2005-06-04 01:29:25 +0400855 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700856 }
857 }
858
Evgeniy Polyakov674a396c2006-02-20 11:15:37 +0300859 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700860}
861
Evgeniy Polyakov12003372006-03-23 19:11:58 +0300862void w1_search_process(struct w1_master *dev, u8 search_type)
863{
864 struct w1_slave *sl, *sln;
865
866 list_for_each_entry(sl, &dev->slist, w1_slave_entry)
867 clear_bit(W1_SLAVE_ACTIVE, (long *)&sl->flags);
868
869 w1_search_devices(dev, search_type, w1_slave_found);
870
871 list_for_each_entry_safe(sl, sln, &dev->slist, w1_slave_entry) {
872 if (!test_bit(W1_SLAVE_ACTIVE, (unsigned long *)&sl->flags) && !--sl->ttl) {
873 w1_slave_detach(sl);
874
875 dev->slave_count--;
876 } else if (test_bit(W1_SLAVE_ACTIVE, (unsigned long *)&sl->flags))
877 sl->ttl = dev->slave_ttl;
878 }
879
880 if (dev->search_count > 0)
881 dev->search_count--;
882}
883
Linus Torvalds1da177e2005-04-16 15:20:36 -0700884int w1_process(void *data)
885{
886 struct w1_master *dev = (struct w1_master *) data;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700887
Evgeniy Polyakov674a396c2006-02-20 11:15:37 +0300888 while (!kthread_should_stop() && !test_bit(W1_MASTER_NEED_EXIT, &dev->flags)) {
Christoph Lameter3e1d1d22005-06-24 23:13:50 -0700889 try_to_freeze();
Linus Torvalds1da177e2005-04-16 15:20:36 -0700890 msleep_interruptible(w1_timeout * 1000);
891
Evgeniy Polyakov674a396c2006-02-20 11:15:37 +0300892 if (kthread_should_stop() || test_bit(W1_MASTER_NEED_EXIT, &dev->flags))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700893 break;
894
895 if (!dev->initialized)
896 continue;
897
Evgeniy Polyakov2a9d0c12005-06-04 01:31:02 +0400898 if (dev->search_count == 0)
899 continue;
900
Evgeniy Polyakovabd52a12006-04-03 12:04:27 +0400901 mutex_lock(&dev->mutex);
Evgeniy Polyakov12003372006-03-23 19:11:58 +0300902 w1_search_process(dev, W1_SEARCH);
Evgeniy Polyakovabd52a12006-04-03 12:04:27 +0400903 mutex_unlock(&dev->mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700904 }
905
906 atomic_dec(&dev->refcnt);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700907
908 return 0;
909}
910
Evgeniy Polyakov77859252005-05-20 22:33:25 +0400911static int w1_init(void)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700912{
913 int retval;
914
915 printk(KERN_INFO "Driver for 1-wire Dallas network protocol.\n");
916
Evgeniy Polyakov12003372006-03-23 19:11:58 +0300917 w1_init_netlink();
918
Linus Torvalds1da177e2005-04-16 15:20:36 -0700919 retval = bus_register(&w1_bus_type);
920 if (retval) {
921 printk(KERN_ERR "Failed to register bus. err=%d.\n", retval);
922 goto err_out_exit_init;
923 }
924
Evgeniy Polyakov7f772ed2005-08-11 13:20:07 +0400925 retval = driver_register(&w1_master_driver);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700926 if (retval) {
927 printk(KERN_ERR
928 "Failed to register master driver. err=%d.\n",
929 retval);
930 goto err_out_bus_unregister;
931 }
932
Evgeniy Polyakov7f772ed2005-08-11 13:20:07 +0400933 retval = driver_register(&w1_slave_driver);
934 if (retval) {
935 printk(KERN_ERR
936 "Failed to register master driver. err=%d.\n",
937 retval);
938 goto err_out_master_unregister;
939 }
940
Evgeniy Polyakov674a396c2006-02-20 11:15:37 +0300941 w1_control_thread = kthread_run(w1_control, NULL, "w1_control");
942 if (IS_ERR(w1_control_thread)) {
943 retval = PTR_ERR(w1_control_thread);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700944 printk(KERN_ERR "Failed to create control thread. err=%d\n",
Evgeniy Polyakov674a396c2006-02-20 11:15:37 +0300945 retval);
Evgeniy Polyakov7f772ed2005-08-11 13:20:07 +0400946 goto err_out_slave_unregister;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700947 }
948
949 return 0;
950
Evgeniy Polyakov7f772ed2005-08-11 13:20:07 +0400951err_out_slave_unregister:
952 driver_unregister(&w1_slave_driver);
953
954err_out_master_unregister:
955 driver_unregister(&w1_master_driver);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700956
957err_out_bus_unregister:
958 bus_unregister(&w1_bus_type);
959
960err_out_exit_init:
961 return retval;
962}
963
Evgeniy Polyakov77859252005-05-20 22:33:25 +0400964static void w1_fini(void)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700965{
966 struct w1_master *dev;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700967
Evgeniy Polyakov77859252005-05-20 22:33:25 +0400968 list_for_each_entry(dev, &w1_masters, w1_master_entry)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700969 __w1_remove_master_device(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700970
Evgeniy Polyakov12003372006-03-23 19:11:58 +0300971 w1_fini_netlink();
972
Evgeniy Polyakov674a396c2006-02-20 11:15:37 +0300973 kthread_stop(w1_control_thread);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700974
Evgeniy Polyakov7f772ed2005-08-11 13:20:07 +0400975 driver_unregister(&w1_slave_driver);
976 driver_unregister(&w1_master_driver);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700977 bus_unregister(&w1_bus_type);
978}
979
980module_init(w1_init);
981module_exit(w1_fini);