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