w1.c 21.8 KB
Newer Older
L
Linus Torvalds 已提交
1
/*
E
Evgeniy Polyakov 已提交
2
 *	w1.c
L
Linus Torvalds 已提交
3 4
 *
 * Copyright (c) 2004 Evgeniy Polyakov <johnpol@2ka.mipt.ru>
E
Evgeniy Polyakov 已提交
5
 *
L
Linus Torvalds 已提交
6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47
 *
 * 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 <johnpol@2ka.mipt.ru>");
MODULE_DESCRIPTION("Driver for 1-wire Dallas network protocol.");

static int w1_timeout = 10;
48
static int w1_control_timeout = 1;
L
Linus Torvalds 已提交
49 50 51 52
int w1_max_slave_count = 10;
int w1_max_slave_ttl = 10;

module_param_named(timeout, w1_timeout, int, 0);
53
module_param_named(control_timeout, w1_control_timeout, int, 0);
L
Linus Torvalds 已提交
54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75
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 void w1_master_release(struct device *dev)
{
76
	struct w1_master *md = dev_to_w1_master(dev);
77 78 79

	dev_dbg(dev, "%s: Releasing %s.\n", __func__, md->name);

80
	dev_fini_netlink(md);
81 82
	memset(md, 0, sizeof(struct w1_master) + sizeof(struct w1_bus_master));
	kfree(md);
L
Linus Torvalds 已提交
83 84 85 86
}

static void w1_slave_release(struct device *dev)
{
87
	struct w1_slave *sl = dev_to_w1_slave(dev);
88 89 90 91 92 93 94 95 96 97 98 99 100 101

	dev_dbg(dev, "%s: Releasing %s.\n", __func__, sl->name);

	while (atomic_read(&sl->refcnt)) {
		dev_dbg(dev, "Waiting for %s to become free: refcnt=%d.\n",
				sl->name, atomic_read(&sl->refcnt));
		if (msleep_interruptible(1000))
			flush_signals(current);
	}

	w1_family_put(sl->family);
	sl->master->slave_count--;

	complete(&sl->released);
L
Linus Torvalds 已提交
102 103
}

104
static ssize_t w1_slave_read_name(struct device *dev, struct device_attribute *attr, char *buf)
L
Linus Torvalds 已提交
105
{
106
	struct w1_slave *sl = dev_to_w1_slave(dev);
107

108
	return sprintf(buf, "%s\n", sl->name);
L
Linus Torvalds 已提交
109 110
}

111
static ssize_t w1_slave_read_id(struct kobject *kobj, char *buf, loff_t off, size_t count)
L
Linus Torvalds 已提交
112
{
113
	struct w1_slave *sl = kobj_to_w1_slave(kobj);
L
Linus Torvalds 已提交
114

115 116 117
	atomic_inc(&sl->refcnt);
	if (off > 8) {
		count = 0;
118 119 120 121 122 123 124 125 126
	} else {
		if (off + count > 8)
			count = 8 - off;

		memcpy(buf, (u8 *)&sl->reg_num, count);
	}
	atomic_dec(&sl->refcnt);

	return count;
127
}
128 129 130 131 132 133 134 135 136 137 138 139

static struct device_attribute w1_slave_attr_name =
	__ATTR(name, S_IRUGO, w1_slave_read_name, NULL);

static struct bin_attribute w1_slave_attr_bin_id = {
      .attr = {
              .name = "id",
              .mode = S_IRUGO,
              .owner = THIS_MODULE,
      },
      .size = 8,
      .read = w1_slave_read_id,
E
Evgeniy Polyakov 已提交
140 141
};

142 143 144
/* Default family */
static struct w1_family w1_default_family;

145
static int w1_uevent(struct device *dev, char **envp, int num_envp, char *buffer, int buffer_size);
E
Evgeniy Polyakov 已提交
146

L
Linus Torvalds 已提交
147 148 149
static struct bus_type w1_bus_type = {
	.name = "w1",
	.match = w1_master_match,
150
	.uevent = w1_uevent,
L
Linus Torvalds 已提交
151 152
};

E
Evgeniy Polyakov 已提交
153 154
struct device_driver w1_master_driver = {
	.name = "w1_master_driver",
L
Linus Torvalds 已提交
155 156 157 158
	.bus = &w1_bus_type,
	.probe = w1_master_probe,
};

E
Evgeniy Polyakov 已提交
159
struct device w1_master_device = {
L
Linus Torvalds 已提交
160 161 162
	.parent = NULL,
	.bus = &w1_bus_type,
	.bus_id = "w1 bus master",
E
Evgeniy Polyakov 已提交
163
	.driver = &w1_master_driver,
L
Linus Torvalds 已提交
164 165 166
	.release = &w1_master_release
};

A
Adrian Bunk 已提交
167
static struct device_driver w1_slave_driver = {
E
Evgeniy Polyakov 已提交
168 169 170 171
	.name = "w1_slave_driver",
	.bus = &w1_bus_type,
};

A
Adrian Bunk 已提交
172
#if 0
E
Evgeniy Polyakov 已提交
173 174 175 176 177
struct device w1_slave_device = {
	.parent = NULL,
	.bus = &w1_bus_type,
	.bus_id = "w1 bus slave",
	.driver = &w1_slave_driver,
178
	.release = &w1_slave_release
E
Evgeniy Polyakov 已提交
179
};
A
Adrian Bunk 已提交
180
#endif  /*  0  */
E
Evgeniy Polyakov 已提交
181

182
static ssize_t w1_master_attribute_show_name(struct device *dev, struct device_attribute *attr, char *buf)
L
Linus Torvalds 已提交
183
{
184
	struct w1_master *md = dev_to_w1_master(dev);
L
Linus Torvalds 已提交
185
	ssize_t count;
E
Evgeniy Polyakov 已提交
186

L
Linus Torvalds 已提交
187 188 189 190
	if (down_interruptible (&md->mutex))
		return -EBUSY;

	count = sprintf(buf, "%s\n", md->name);
E
Evgeniy Polyakov 已提交
191

L
Linus Torvalds 已提交
192 193 194 195 196
	up(&md->mutex);

	return count;
}

197 198 199 200
static ssize_t w1_master_attribute_store_search(struct device * dev,
						struct device_attribute *attr,
						const char * buf, size_t count)
{
201
	struct w1_master *md = dev_to_w1_master(dev);
202 203 204 205 206 207 208 209 210 211 212 213 214 215 216

	if (down_interruptible (&md->mutex))
		return -EBUSY;

	md->search_count = simple_strtol(buf, NULL, 0);

	up(&md->mutex);

	return count;
}

static ssize_t w1_master_attribute_show_search(struct device *dev,
					       struct device_attribute *attr,
					       char *buf)
{
217
	struct w1_master *md = dev_to_w1_master(dev);
218 219 220 221 222 223 224 225 226 227 228 229
	ssize_t count;

	if (down_interruptible (&md->mutex))
		return -EBUSY;

	count = sprintf(buf, "%d\n", md->search_count);

	up(&md->mutex);

	return count;
}

230
static ssize_t w1_master_attribute_show_pointer(struct device *dev, struct device_attribute *attr, char *buf)
L
Linus Torvalds 已提交
231
{
232
	struct w1_master *md = dev_to_w1_master(dev);
L
Linus Torvalds 已提交
233
	ssize_t count;
E
Evgeniy Polyakov 已提交
234

L
Linus Torvalds 已提交
235 236 237 238
	if (down_interruptible(&md->mutex))
		return -EBUSY;

	count = sprintf(buf, "0x%p\n", md->bus_master);
E
Evgeniy Polyakov 已提交
239

L
Linus Torvalds 已提交
240 241 242 243
	up(&md->mutex);
	return count;
}

244
static ssize_t w1_master_attribute_show_timeout(struct device *dev, struct device_attribute *attr, char *buf)
L
Linus Torvalds 已提交
245 246 247 248 249 250
{
	ssize_t count;
	count = sprintf(buf, "%d\n", w1_timeout);
	return count;
}

251
static ssize_t w1_master_attribute_show_max_slave_count(struct device *dev, struct device_attribute *attr, char *buf)
L
Linus Torvalds 已提交
252
{
253
	struct w1_master *md = dev_to_w1_master(dev);
L
Linus Torvalds 已提交
254
	ssize_t count;
E
Evgeniy Polyakov 已提交
255

L
Linus Torvalds 已提交
256 257 258 259
	if (down_interruptible(&md->mutex))
		return -EBUSY;

	count = sprintf(buf, "%d\n", md->max_slave_count);
E
Evgeniy Polyakov 已提交
260

L
Linus Torvalds 已提交
261 262 263 264
	up(&md->mutex);
	return count;
}

265
static ssize_t w1_master_attribute_show_attempts(struct device *dev, struct device_attribute *attr, char *buf)
L
Linus Torvalds 已提交
266
{
267
	struct w1_master *md = dev_to_w1_master(dev);
L
Linus Torvalds 已提交
268
	ssize_t count;
E
Evgeniy Polyakov 已提交
269

L
Linus Torvalds 已提交
270 271 272 273
	if (down_interruptible(&md->mutex))
		return -EBUSY;

	count = sprintf(buf, "%lu\n", md->attempts);
E
Evgeniy Polyakov 已提交
274

L
Linus Torvalds 已提交
275 276 277 278
	up(&md->mutex);
	return count;
}

279
static ssize_t w1_master_attribute_show_slave_count(struct device *dev, struct device_attribute *attr, char *buf)
L
Linus Torvalds 已提交
280
{
281
	struct w1_master *md = dev_to_w1_master(dev);
L
Linus Torvalds 已提交
282
	ssize_t count;
E
Evgeniy Polyakov 已提交
283

L
Linus Torvalds 已提交
284 285 286 287
	if (down_interruptible(&md->mutex))
		return -EBUSY;

	count = sprintf(buf, "%d\n", md->slave_count);
E
Evgeniy Polyakov 已提交
288

L
Linus Torvalds 已提交
289 290 291 292
	up(&md->mutex);
	return count;
}

293
static ssize_t w1_master_attribute_show_slaves(struct device *dev, struct device_attribute *attr, char *buf)
L
Linus Torvalds 已提交
294
{
295
	struct w1_master *md = dev_to_w1_master(dev);
L
Linus Torvalds 已提交
296 297 298 299 300 301 302 303 304 305 306 307 308 309
	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);

E
Evgeniy Polyakov 已提交
310
			c -= snprintf(buf + PAGE_SIZE - c, c, "%s\n", sl->name);
L
Linus Torvalds 已提交
311 312 313 314 315 316 317 318
		}
	}

	up(&md->mutex);

	return PAGE_SIZE - c;
}

E
Evgeniy Polyakov 已提交
319 320 321 322 323
#define W1_MASTER_ATTR_RO(_name, _mode)				\
	struct device_attribute w1_master_attribute_##_name =	\
		__ATTR(w1_master_##_name, _mode,		\
		       w1_master_attribute_show_##_name, NULL)

324 325 326 327 328 329
#define W1_MASTER_ATTR_RW(_name, _mode)				\
	struct device_attribute w1_master_attribute_##_name =	\
		__ATTR(w1_master_##_name, _mode,		\
		       w1_master_attribute_show_##_name,	\
		       w1_master_attribute_store_##_name)

E
Evgeniy Polyakov 已提交
330 331 332 333 334 335 336
static W1_MASTER_ATTR_RO(name, S_IRUGO);
static W1_MASTER_ATTR_RO(slaves, S_IRUGO);
static W1_MASTER_ATTR_RO(slave_count, S_IRUGO);
static W1_MASTER_ATTR_RO(max_slave_count, S_IRUGO);
static W1_MASTER_ATTR_RO(attempts, S_IRUGO);
static W1_MASTER_ATTR_RO(timeout, S_IRUGO);
static W1_MASTER_ATTR_RO(pointer, S_IRUGO);
337
static W1_MASTER_ATTR_RW(search, S_IRUGO | S_IWUGO);
E
Evgeniy Polyakov 已提交
338 339 340 341 342 343 344 345 346

static struct attribute *w1_master_default_attrs[] = {
	&w1_master_attribute_name.attr,
	&w1_master_attribute_slaves.attr,
	&w1_master_attribute_slave_count.attr,
	&w1_master_attribute_max_slave_count.attr,
	&w1_master_attribute_attempts.attr,
	&w1_master_attribute_timeout.attr,
	&w1_master_attribute_pointer.attr,
347
	&w1_master_attribute_search.attr,
E
Evgeniy Polyakov 已提交
348
	NULL
L
Linus Torvalds 已提交
349 350
};

E
Evgeniy Polyakov 已提交
351 352
static struct attribute_group w1_master_defattr_group = {
	.attrs = w1_master_default_attrs,
L
Linus Torvalds 已提交
353 354
};

E
Evgeniy Polyakov 已提交
355 356 357 358 359
int w1_create_master_attributes(struct w1_master *master)
{
	return sysfs_create_group(&master->dev.kobj, &w1_master_defattr_group);
}

A
Adrian Bunk 已提交
360
static void w1_destroy_master_attributes(struct w1_master *master)
E
Evgeniy Polyakov 已提交
361 362 363 364
{
	sysfs_remove_group(&master->dev.kobj, &w1_master_defattr_group);
}

E
Evgeniy Polyakov 已提交
365
#ifdef CONFIG_HOTPLUG
366
static int w1_uevent(struct device *dev, char **envp, int num_envp, char *buffer, int buffer_size)
E
Evgeniy Polyakov 已提交
367 368 369 370 371 372 373 374 375 376 377 378 379 380 381
{
	struct w1_master *md = NULL;
	struct w1_slave *sl = NULL;
	char *event_owner, *name;
	int err, cur_index=0, cur_len=0;

	if (dev->driver == &w1_master_driver) {
		md = container_of(dev, struct w1_master, dev);
		event_owner = "master";
		name = md->name;
	} else if (dev->driver == &w1_slave_driver) {
		sl = container_of(dev, struct w1_slave, dev);
		event_owner = "slave";
		name = sl->name;
	} else {
382
		dev_dbg(dev, "Unknown event.\n");
E
Evgeniy Polyakov 已提交
383 384 385 386 387 388 389 390
		return -EINVAL;
	}

	dev_dbg(dev, "Hotplug event for %s %s, bus_id=%s.\n", event_owner, name, dev->bus_id);

	if (dev->driver != &w1_slave_driver || !sl)
		return 0;

391
	err = add_uevent_var(envp, num_envp, &cur_index, buffer, buffer_size, &cur_len, "W1_FID=%02X", sl->reg_num.family);
E
Evgeniy Polyakov 已提交
392 393 394
	if (err)
		return err;

395
	err = add_uevent_var(envp, num_envp, &cur_index, buffer, buffer_size, &cur_len, "W1_SLAVE_ID=%024LX", (u64)sl->reg_num.id);
E
Evgeniy Polyakov 已提交
396 397 398 399 400 401
	if (err)
		return err;

	return 0;
};
#else
402
static int w1_uevent(struct device *dev, char **envp, int num_envp, char *buffer, int buffer_size)
E
Evgeniy Polyakov 已提交
403 404 405 406 407
{
	return 0;
}
#endif

L
Linus Torvalds 已提交
408 409 410 411 412
static int __w1_attach_slave_device(struct w1_slave *sl)
{
	int err;

	sl->dev.parent = &sl->master->dev;
E
Evgeniy Polyakov 已提交
413
	sl->dev.driver = &w1_slave_driver;
L
Linus Torvalds 已提交
414 415 416 417
	sl->dev.bus = &w1_bus_type;
	sl->dev.release = &w1_slave_release;

	snprintf(&sl->dev.bus_id[0], sizeof(sl->dev.bus_id),
418 419 420 421 422 423 424
		 "%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);
L
Linus Torvalds 已提交
425

426
	dev_dbg(&sl->dev, "%s: registering %s as %p.\n", __func__, &sl->dev.bus_id[0]);
L
Linus Torvalds 已提交
427 428 429 430

	err = device_register(&sl->dev);
	if (err < 0) {
		dev_err(&sl->dev,
431 432
			"Device registration [%s] failed. err=%d\n",
			sl->dev.bus_id, err);
L
Linus Torvalds 已提交
433 434 435
		return err;
	}

436 437 438 439 440 441 442 443
	/* Create "name" entry */
	err = device_create_file(&sl->dev, &w1_slave_attr_name);
	if (err < 0) {
		dev_err(&sl->dev,
			"sysfs file creation for [%s] failed. err=%d\n",
			sl->dev.bus_id, err);
		goto out_unreg;
	}
L
Linus Torvalds 已提交
444

445 446
	/* Create "id" entry */
	err = sysfs_create_bin_file(&sl->dev.kobj, &w1_slave_attr_bin_id);
L
Linus Torvalds 已提交
447 448
	if (err < 0) {
		dev_err(&sl->dev,
449 450
			"sysfs file creation for [%s] failed. err=%d\n",
			sl->dev.bus_id, err);
451
		goto out_rem1;
L
Linus Torvalds 已提交
452 453
	}

454 455 456 457 458 459 460
	/* if the family driver needs to initialize something... */
	if (sl->family->fops && sl->family->fops->add_slave &&
	    ((err = sl->family->fops->add_slave(sl)) < 0)) {
		dev_err(&sl->dev,
			"sysfs file creation for [%s] failed. err=%d\n",
			sl->dev.bus_id, err);
		goto out_rem2;
L
Linus Torvalds 已提交
461 462 463 464 465
	}

	list_add_tail(&sl->w1_slave_entry, &sl->master->slist);

	return 0;
466 467 468 469 470 471 472 473

out_rem2:
	sysfs_remove_bin_file(&sl->dev.kobj, &w1_slave_attr_bin_id);
out_rem1:
	device_remove_file(&sl->dev, &w1_slave_attr_name);
out_unreg:
	device_unregister(&sl->dev);
	return err;
L
Linus Torvalds 已提交
474 475 476 477 478 479 480 481 482 483 484 485 486 487 488 489 490 491 492 493 494 495 496 497 498
}

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);
499
	init_completion(&sl->released);
L
Linus Torvalds 已提交
500 501 502 503

	spin_lock(&w1_flock);
	f = w1_family_registered(rn->family);
	if (!f) {
504
		f= &w1_default_family;
L
Linus Torvalds 已提交
505 506 507 508 509 510 511 512 513 514 515 516 517 518 519 520 521 522 523 524 525 526 527 528 529 530 531 532 533 534 535 536
		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);
	}
	__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;
E
Evgeniy Polyakov 已提交
537

538
	dev_dbg(&sl->dev, "%s: detaching %s [%p].\n", __func__, sl->name, sl);
L
Linus Torvalds 已提交
539

540
	list_del(&sl->w1_slave_entry);
L
Linus Torvalds 已提交
541

542 543 544
	if (sl->family->fops && sl->family->fops->remove_slave)
		sl->family->fops->remove_slave(sl);

545 546 547 548
	memcpy(&msg.id.id, &sl->reg_num, sizeof(msg.id.id));
	msg.type = W1_SLAVE_REMOVE;
	w1_netlink_send(sl->master, &msg);

549 550
	sysfs_remove_bin_file(&sl->dev.kobj, &w1_slave_attr_bin_id);
	device_remove_file(&sl->dev, &w1_slave_attr_name);
L
Linus Torvalds 已提交
551 552
	device_unregister(&sl->dev);

553 554
	wait_for_completion(&sl->released);
	kfree(sl);
L
Linus Torvalds 已提交
555 556
}

557
static struct w1_master *w1_search_master(void *data)
L
Linus Torvalds 已提交
558 559 560
{
	struct w1_master *dev;
	int found = 0;
E
Evgeniy Polyakov 已提交
561 562

	spin_lock_bh(&w1_mlock);
L
Linus Torvalds 已提交
563 564 565 566 567 568 569
	list_for_each_entry(dev, &w1_masters, w1_master_entry) {
		if (dev->bus_master->data == data) {
			found = 1;
			atomic_inc(&dev->refcnt);
			break;
		}
	}
E
Evgeniy Polyakov 已提交
570
	spin_unlock_bh(&w1_mlock);
L
Linus Torvalds 已提交
571 572 573 574

	return (found)?dev:NULL;
}

575 576 577 578 579 580
void w1_reconnect_slaves(struct w1_family *f)
{
	struct w1_master *dev;

	spin_lock_bh(&w1_mlock);
	list_for_each_entry(dev, &w1_masters, w1_master_entry) {
581
		dev_dbg(&dev->dev, "Reconnecting slaves in %s into new family %02x.\n",
582 583 584 585 586 587
				dev->name, f->fid);
		set_bit(W1_MASTER_NEED_RECONNECT, &dev->flags);
	}
	spin_unlock_bh(&w1_mlock);
}

588
static void w1_slave_found(void *data, u64 rn)
L
Linus Torvalds 已提交
589 590 591 592 593 594 595
{
	int slave_count;
	struct w1_slave *sl;
	struct list_head *ent;
	struct w1_reg_num *tmp;
	int family_found = 0;
	struct w1_master *dev;
596
	u64 rn_le = cpu_to_le64(rn);
L
Linus Torvalds 已提交
597 598 599

	dev = w1_search_master(data);
	if (!dev) {
600 601
		printk(KERN_ERR "Failed to find w1 master device for data %p, "
		       "it is impossible.\n", data);
L
Linus Torvalds 已提交
602 603
		return;
	}
E
Evgeniy Polyakov 已提交
604

L
Linus Torvalds 已提交
605 606 607 608 609 610 611 612 613 614 615 616
	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;
E
Evgeniy Polyakov 已提交
617
		} else if (sl->reg_num.family == tmp->family) {
L
Linus Torvalds 已提交
618 619 620 621 622 623 624
			family_found = 1;
			break;
		}

		slave_count++;
	}

625
	if (slave_count == dev->slave_count &&
626
		rn && ((rn >> 56) & 0xff) == w1_calc_crc8((u8 *)&rn_le, 7)) {
627
		w1_attach_slave_device(dev, tmp);
L
Linus Torvalds 已提交
628
	}
E
Evgeniy Polyakov 已提交
629

L
Linus Torvalds 已提交
630 631 632
	atomic_dec(&dev->refcnt);
}

633 634 635 636 637 638 639 640 641 642 643 644 645 646 647
/**
 * Performs a ROM Search & registers any devices found.
 * The 1-wire search is a simple binary tree search.
 * For each bit of the address, we read two bits and write one bit.
 * The bit written will put to sleep all devies that don't match that bit.
 * When the two reads differ, the direction choice is obvious.
 * When both bits are 0, we must choose a path to take.
 * When we can scan all 64 bits without having to choose a path, we are done.
 *
 * See "Application note 187 1-wire search algorithm" at www.maxim-ic.com
 *
 * @dev        The master device to search
 * @cb         Function to call when a device is found
 */
void w1_search(struct w1_master *dev, w1_slave_found_callback cb)
L
Linus Torvalds 已提交
648
{
649 650 651 652 653
	u64 last_rn, rn, tmp64;
	int i, slave_count = 0;
	int last_zero, last_device;
	int search_bit, desc_bit;
	u8  triplet_ret = 0;
L
Linus Torvalds 已提交
654

655 656 657 658
	search_bit = 0;
	rn = last_rn = 0;
	last_device = 0;
	last_zero = -1;
L
Linus Torvalds 已提交
659 660 661

	desc_bit = 64;

662 663
	while ( !last_device && (slave_count++ < dev->max_slave_count) ) {
		last_rn = rn;
L
Linus Torvalds 已提交
664 665 666 667 668 669 670 671 672
		rn = 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)) {
673
			dev_dbg(&dev->dev, "No devices present on the wire.\n");
L
Linus Torvalds 已提交
674 675 676
			break;
		}

677
		/* Start the search */
L
Linus Torvalds 已提交
678 679
		w1_write_8(dev, W1_SEARCH);
		for (i = 0; i < 64; ++i) {
680 681 682 683 684
			/* Determine the direction/search bit */
			if (i == desc_bit)
				search_bit = 1;	  /* took the 0 path last time, so take the 1 path */
			else if (i > desc_bit)
				search_bit = 0;	  /* take the 0 path on the next branch */
L
Linus Torvalds 已提交
685
			else
686
				search_bit = ((last_rn >> i) & 0x1);
L
Linus Torvalds 已提交
687

688 689 690 691 692 693
			/** Read two bits and write one bit */
			triplet_ret = w1_triplet(dev, search_bit);

			/* quit if no device responded */
			if ( (triplet_ret & 0x03) == 0x03 )
				break;
L
Linus Torvalds 已提交
694

695 696 697
			/* If both directions were valid, and we took the 0 path... */
			if (triplet_ret == 0)
				last_zero = i;
L
Linus Torvalds 已提交
698

699 700 701 702
			/* extract the direction taken & update the device number */
			tmp64 = (triplet_ret >> 2);
			rn |= (tmp64 << i);
		}
E
Evgeniy Polyakov 已提交
703

704 705 706 707 708 709
		if ( (triplet_ret & 0x03) != 0x03 ) {
			if ( (desc_bit == last_zero) || (last_zero < 0))
				last_device = 1;
			desc_bit = last_zero;
			cb(dev->bus_master->data, rn);
		}
L
Linus Torvalds 已提交
710 711 712
	}
}

E
Evgeniy Polyakov 已提交
713
static int w1_control(void *data)
L
Linus Torvalds 已提交
714
{
E
Evgeniy Polyakov 已提交
715 716
	struct w1_slave *sl, *sln;
	struct w1_master *dev, *n;
L
Linus Torvalds 已提交
717 718 719 720 721 722 723 724
	int err, have_to_wait = 0;

	daemonize("w1_control");
	allow_signal(SIGTERM);

	while (!control_needs_exit || have_to_wait) {
		have_to_wait = 0;

725
		try_to_freeze();
726
		msleep_interruptible(w1_control_timeout * 1000);
L
Linus Torvalds 已提交
727 728 729 730

		if (signal_pending(current))
			flush_signals(current);

E
Evgeniy Polyakov 已提交
731
		list_for_each_entry_safe(dev, n, &w1_masters, w1_master_entry) {
732
			if (!control_needs_exit && !dev->flags)
L
Linus Torvalds 已提交
733 734 735 736 737 738 739 740 741 742 743
				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;
			}

			if (control_needs_exit) {
744
				set_bit(W1_MASTER_NEED_EXIT, &dev->flags);
L
Linus Torvalds 已提交
745 746 747 748 749 750 751 752

				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);
			}

753 754 755 756 757 758
			if (test_bit(W1_MASTER_NEED_EXIT, &dev->flags)) {
				wait_for_completion(&dev->dev_exited);
				spin_lock_bh(&w1_mlock);
				list_del(&dev->w1_master_entry);
				spin_unlock_bh(&w1_mlock);

759
				down(&dev->mutex);
760 761 762 763
				list_for_each_entry_safe(sl, sln, &dev->slist, w1_slave_entry) {
					w1_slave_detach(sl);
				}
				w1_destroy_master_attributes(dev);
764
				up(&dev->mutex);
765 766 767 768 769
				atomic_dec(&dev->refcnt);
				continue;
			}

			if (test_bit(W1_MASTER_NEED_RECONNECT, &dev->flags)) {
770
				dev_dbg(&dev->dev, "Reconnecting slaves in device %s.\n", dev->name);
771
				down(&dev->mutex);
772
				list_for_each_entry_safe(sl, sln, &dev->slist, w1_slave_entry) {
773 774 775 776
					if (sl->family->fid == W1_FAMILY_DEFAULT) {
						struct w1_reg_num rn;

						memcpy(&rn, &sl->reg_num, sizeof(rn));
777
						w1_slave_detach(sl);
L
Linus Torvalds 已提交
778

779 780 781
						w1_attach_slave_device(dev, &rn);
					}
				}
782
				dev_dbg(&dev->dev, "Reconnecting slaves in device %s has been finished.\n", dev->name);
783 784
				clear_bit(W1_MASTER_NEED_RECONNECT, &dev->flags);
				up(&dev->mutex);
L
Linus Torvalds 已提交
785 786 787 788 789 790 791 792 793 794
			}
		}
	}

	complete_and_exit(&w1_control_complete, 0);
}

int w1_process(void *data)
{
	struct w1_master *dev = (struct w1_master *) data;
E
Evgeniy Polyakov 已提交
795
	struct w1_slave *sl, *sln;
L
Linus Torvalds 已提交
796 797 798 799

	daemonize("%s", dev->name);
	allow_signal(SIGTERM);

800
	while (!test_bit(W1_MASTER_NEED_EXIT, &dev->flags)) {
801
		try_to_freeze();
L
Linus Torvalds 已提交
802 803 804 805 806
		msleep_interruptible(w1_timeout * 1000);

		if (signal_pending(current))
			flush_signals(current);

807
		if (test_bit(W1_MASTER_NEED_EXIT, &dev->flags))
L
Linus Torvalds 已提交
808 809 810 811 812
			break;

		if (!dev->initialized)
			continue;

813 814 815
		if (dev->search_count == 0)
			continue;

L
Linus Torvalds 已提交
816 817 818
		if (down_interruptible(&dev->mutex))
			continue;

E
Evgeniy Polyakov 已提交
819
		list_for_each_entry(sl, &dev->slist, w1_slave_entry)
820
			clear_bit(W1_SLAVE_ACTIVE, (long *)&sl->flags);
L
Linus Torvalds 已提交
821

E
Evgeniy Polyakov 已提交
822
		w1_search_devices(dev, w1_slave_found);
L
Linus Torvalds 已提交
823

E
Evgeniy Polyakov 已提交
824 825
		list_for_each_entry_safe(sl, sln, &dev->slist, w1_slave_entry) {
			if (!test_bit(W1_SLAVE_ACTIVE, (unsigned long *)&sl->flags) && !--sl->ttl) {
826
				w1_slave_detach(sl);
L
Linus Torvalds 已提交
827 828

				dev->slave_count--;
E
Evgeniy Polyakov 已提交
829
			} else if (test_bit(W1_SLAVE_ACTIVE, (unsigned long *)&sl->flags))
L
Linus Torvalds 已提交
830 831
				sl->ttl = dev->slave_ttl;
		}
832 833 834 835

		if (dev->search_count > 0)
			dev->search_count--;

L
Linus Torvalds 已提交
836 837 838 839 840 841 842 843 844
		up(&dev->mutex);
	}

	atomic_dec(&dev->refcnt);
	complete_and_exit(&dev->dev_exited, 0);

	return 0;
}

E
Evgeniy Polyakov 已提交
845
static int w1_init(void)
L
Linus Torvalds 已提交
846 847 848 849 850 851 852 853 854 855 856
{
	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;
	}

E
Evgeniy Polyakov 已提交
857
	retval = driver_register(&w1_master_driver);
L
Linus Torvalds 已提交
858 859 860 861 862 863 864
	if (retval) {
		printk(KERN_ERR
			"Failed to register master driver. err=%d.\n",
			retval);
		goto err_out_bus_unregister;
	}

E
Evgeniy Polyakov 已提交
865 866 867 868 869 870 871 872
	retval = driver_register(&w1_slave_driver);
	if (retval) {
		printk(KERN_ERR
			"Failed to register master driver. err=%d.\n",
			retval);
		goto err_out_master_unregister;
	}

L
Linus Torvalds 已提交
873 874 875 876 877
	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;
E
Evgeniy Polyakov 已提交
878
		goto err_out_slave_unregister;
L
Linus Torvalds 已提交
879 880 881 882
	}

	return 0;

E
Evgeniy Polyakov 已提交
883 884 885 886 887
err_out_slave_unregister:
	driver_unregister(&w1_slave_driver);

err_out_master_unregister:
	driver_unregister(&w1_master_driver);
L
Linus Torvalds 已提交
888 889 890 891 892 893 894 895

err_out_bus_unregister:
	bus_unregister(&w1_bus_type);

err_out_exit_init:
	return retval;
}

E
Evgeniy Polyakov 已提交
896
static void w1_fini(void)
L
Linus Torvalds 已提交
897 898 899
{
	struct w1_master *dev;

E
Evgeniy Polyakov 已提交
900
	list_for_each_entry(dev, &w1_masters, w1_master_entry)
L
Linus Torvalds 已提交
901 902 903 904 905
		__w1_remove_master_device(dev);

	control_needs_exit = 1;
	wait_for_completion(&w1_control_complete);

E
Evgeniy Polyakov 已提交
906 907
	driver_unregister(&w1_slave_driver);
	driver_unregister(&w1_master_driver);
L
Linus Torvalds 已提交
908 909 910 911 912
	bus_unregister(&w1_bus_type);
}

module_init(w1_init);
module_exit(w1_fini);