| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1 | /* | 
| Evgeniy Polyakov | 7785925 | 2005-05-20 22:33:25 +0400 | [diff] [blame] | 2 | *	w1_family.c | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3 | * | 
| Evgeniy Polyakov | a801876 | 2011-08-25 15:59:06 -0700 | [diff] [blame] | 4 | * Copyright (c) 2004 Evgeniy Polyakov <zbr@ioremap.net> | 
| Evgeniy Polyakov | 7785925 | 2005-05-20 22:33:25 +0400 | [diff] [blame] | 5 | * | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 6 | * | 
|  | 7 | * This program is free software; you can redistribute it and/or modify | 
|  | 8 | * it under the terms of the GNU General Public License as published by | 
|  | 9 | * the Free Software Foundation; either version 2 of the License, or | 
|  | 10 | * (at your option) any later version. | 
|  | 11 | * | 
|  | 12 | * This program is distributed in the hope that it will be useful, | 
|  | 13 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | 
|  | 14 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the | 
|  | 15 | * GNU General Public License for more details. | 
|  | 16 | * | 
|  | 17 | * You should have received a copy of the GNU General Public License | 
|  | 18 | * along with this program; if not, write to the Free Software | 
|  | 19 | * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA | 
|  | 20 | */ | 
|  | 21 |  | 
|  | 22 | #include <linux/spinlock.h> | 
|  | 23 | #include <linux/list.h> | 
| Tim Schmielau | 4e57b68 | 2005-10-30 15:03:48 -0800 | [diff] [blame] | 24 | #include <linux/sched.h>	/* schedule_timeout() */ | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 25 | #include <linux/delay.h> | 
| Paul Gortmaker | 9623932 | 2011-07-10 13:21:52 -0400 | [diff] [blame] | 26 | #include <linux/export.h> | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 27 |  | 
|  | 28 | #include "w1_family.h" | 
| Adrian Bunk | a9fb1c7 | 2005-12-13 14:04:33 -0800 | [diff] [blame] | 29 | #include "w1.h" | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 30 |  | 
|  | 31 | DEFINE_SPINLOCK(w1_flock); | 
|  | 32 | static LIST_HEAD(w1_families); | 
|  | 33 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 34 | int w1_register_family(struct w1_family *newf) | 
|  | 35 | { | 
|  | 36 | struct list_head *ent, *n; | 
|  | 37 | struct w1_family *f; | 
|  | 38 | int ret = 0; | 
|  | 39 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 40 | spin_lock(&w1_flock); | 
|  | 41 | list_for_each_safe(ent, n, &w1_families) { | 
|  | 42 | f = list_entry(ent, struct w1_family, family_entry); | 
|  | 43 |  | 
|  | 44 | if (f->fid == newf->fid) { | 
|  | 45 | ret = -EEXIST; | 
|  | 46 | break; | 
|  | 47 | } | 
|  | 48 | } | 
|  | 49 |  | 
|  | 50 | if (!ret) { | 
|  | 51 | atomic_set(&newf->refcnt, 0); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 52 | list_add_tail(&newf->family_entry, &w1_families); | 
|  | 53 | } | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 54 | spin_unlock(&w1_flock); | 
|  | 55 |  | 
| David Fries | c30c9b1 | 2008-10-15 22:04:38 -0700 | [diff] [blame] | 56 | /* check default devices against the new set of drivers */ | 
|  | 57 | w1_reconnect_slaves(newf, 1); | 
| Evgeniy Polyakov | 6adf87b | 2005-06-04 01:29:25 +0400 | [diff] [blame] | 58 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 59 | return ret; | 
|  | 60 | } | 
|  | 61 |  | 
|  | 62 | void w1_unregister_family(struct w1_family *fent) | 
|  | 63 | { | 
|  | 64 | struct list_head *ent, *n; | 
|  | 65 | struct w1_family *f; | 
|  | 66 |  | 
|  | 67 | spin_lock(&w1_flock); | 
|  | 68 | list_for_each_safe(ent, n, &w1_families) { | 
|  | 69 | f = list_entry(ent, struct w1_family, family_entry); | 
|  | 70 |  | 
|  | 71 | if (f->fid == fent->fid) { | 
|  | 72 | list_del(&fent->family_entry); | 
|  | 73 | break; | 
|  | 74 | } | 
|  | 75 | } | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 76 | spin_unlock(&w1_flock); | 
|  | 77 |  | 
| David Fries | c30c9b1 | 2008-10-15 22:04:38 -0700 | [diff] [blame] | 78 | /* deatch devices using this family code */ | 
|  | 79 | w1_reconnect_slaves(fent, 0); | 
|  | 80 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 81 | while (atomic_read(&fent->refcnt)) { | 
|  | 82 | printk(KERN_INFO "Waiting for family %u to become free: refcnt=%d.\n", | 
|  | 83 | fent->fid, atomic_read(&fent->refcnt)); | 
|  | 84 |  | 
|  | 85 | if (msleep_interruptible(1000)) | 
|  | 86 | flush_signals(current); | 
|  | 87 | } | 
|  | 88 | } | 
|  | 89 |  | 
|  | 90 | /* | 
|  | 91 | * Should be called under w1_flock held. | 
|  | 92 | */ | 
|  | 93 | struct w1_family * w1_family_registered(u8 fid) | 
|  | 94 | { | 
|  | 95 | struct list_head *ent, *n; | 
|  | 96 | struct w1_family *f = NULL; | 
|  | 97 | int ret = 0; | 
|  | 98 |  | 
|  | 99 | list_for_each_safe(ent, n, &w1_families) { | 
|  | 100 | f = list_entry(ent, struct w1_family, family_entry); | 
|  | 101 |  | 
|  | 102 | if (f->fid == fid) { | 
|  | 103 | ret = 1; | 
|  | 104 | break; | 
|  | 105 | } | 
|  | 106 | } | 
|  | 107 |  | 
|  | 108 | return (ret) ? f : NULL; | 
|  | 109 | } | 
|  | 110 |  | 
| Evgeniy Polyakov | 70d484b | 2006-04-24 10:46:14 +0400 | [diff] [blame] | 111 | static void __w1_family_put(struct w1_family *f) | 
|  | 112 | { | 
| David Fries | fe3cb82 | 2008-10-15 22:04:52 -0700 | [diff] [blame] | 113 | atomic_dec(&f->refcnt); | 
| Evgeniy Polyakov | 70d484b | 2006-04-24 10:46:14 +0400 | [diff] [blame] | 114 | } | 
|  | 115 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 116 | void w1_family_put(struct w1_family *f) | 
|  | 117 | { | 
|  | 118 | spin_lock(&w1_flock); | 
|  | 119 | __w1_family_put(f); | 
|  | 120 | spin_unlock(&w1_flock); | 
|  | 121 | } | 
|  | 122 |  | 
| Evgeniy Polyakov | 70d484b | 2006-04-24 10:46:14 +0400 | [diff] [blame] | 123 | #if 0 | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 124 | void w1_family_get(struct w1_family *f) | 
|  | 125 | { | 
|  | 126 | spin_lock(&w1_flock); | 
|  | 127 | __w1_family_get(f); | 
|  | 128 | spin_unlock(&w1_flock); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 129 | } | 
| Evgeniy Polyakov | 70d484b | 2006-04-24 10:46:14 +0400 | [diff] [blame] | 130 | #endif  /*  0  */ | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 131 |  | 
|  | 132 | void __w1_family_get(struct w1_family *f) | 
|  | 133 | { | 
|  | 134 | smp_mb__before_atomic_inc(); | 
|  | 135 | atomic_inc(&f->refcnt); | 
|  | 136 | smp_mb__after_atomic_inc(); | 
|  | 137 | } | 
|  | 138 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 139 | EXPORT_SYMBOL(w1_unregister_family); | 
|  | 140 | EXPORT_SYMBOL(w1_register_family); |