18c2ecf20Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0-or-later 28c2ecf20Sopenharmony_ci/* 38c2ecf20Sopenharmony_ci * Copyright (c) 2004 Evgeniy Polyakov <zbr@ioremap.net> 48c2ecf20Sopenharmony_ci */ 58c2ecf20Sopenharmony_ci 68c2ecf20Sopenharmony_ci#include <linux/spinlock.h> 78c2ecf20Sopenharmony_ci#include <linux/list.h> 88c2ecf20Sopenharmony_ci#include <linux/sched/signal.h> 98c2ecf20Sopenharmony_ci#include <linux/delay.h> 108c2ecf20Sopenharmony_ci#include <linux/export.h> 118c2ecf20Sopenharmony_ci 128c2ecf20Sopenharmony_ci#include "w1_internal.h" 138c2ecf20Sopenharmony_ci 148c2ecf20Sopenharmony_ciDEFINE_SPINLOCK(w1_flock); 158c2ecf20Sopenharmony_cistatic LIST_HEAD(w1_families); 168c2ecf20Sopenharmony_ci 178c2ecf20Sopenharmony_ci/** 188c2ecf20Sopenharmony_ci * w1_register_family() - register a device family driver 198c2ecf20Sopenharmony_ci * @newf: family to register 208c2ecf20Sopenharmony_ci */ 218c2ecf20Sopenharmony_ciint w1_register_family(struct w1_family *newf) 228c2ecf20Sopenharmony_ci{ 238c2ecf20Sopenharmony_ci struct list_head *ent, *n; 248c2ecf20Sopenharmony_ci struct w1_family *f; 258c2ecf20Sopenharmony_ci int ret = 0; 268c2ecf20Sopenharmony_ci 278c2ecf20Sopenharmony_ci spin_lock(&w1_flock); 288c2ecf20Sopenharmony_ci list_for_each_safe(ent, n, &w1_families) { 298c2ecf20Sopenharmony_ci f = list_entry(ent, struct w1_family, family_entry); 308c2ecf20Sopenharmony_ci 318c2ecf20Sopenharmony_ci if (f->fid == newf->fid) { 328c2ecf20Sopenharmony_ci ret = -EEXIST; 338c2ecf20Sopenharmony_ci break; 348c2ecf20Sopenharmony_ci } 358c2ecf20Sopenharmony_ci } 368c2ecf20Sopenharmony_ci 378c2ecf20Sopenharmony_ci if (!ret) { 388c2ecf20Sopenharmony_ci atomic_set(&newf->refcnt, 0); 398c2ecf20Sopenharmony_ci list_add_tail(&newf->family_entry, &w1_families); 408c2ecf20Sopenharmony_ci } 418c2ecf20Sopenharmony_ci spin_unlock(&w1_flock); 428c2ecf20Sopenharmony_ci 438c2ecf20Sopenharmony_ci /* check default devices against the new set of drivers */ 448c2ecf20Sopenharmony_ci w1_reconnect_slaves(newf, 1); 458c2ecf20Sopenharmony_ci 468c2ecf20Sopenharmony_ci return ret; 478c2ecf20Sopenharmony_ci} 488c2ecf20Sopenharmony_ciEXPORT_SYMBOL(w1_register_family); 498c2ecf20Sopenharmony_ci 508c2ecf20Sopenharmony_ci/** 518c2ecf20Sopenharmony_ci * w1_unregister_family() - unregister a device family driver 528c2ecf20Sopenharmony_ci * @fent: family to unregister 538c2ecf20Sopenharmony_ci */ 548c2ecf20Sopenharmony_civoid w1_unregister_family(struct w1_family *fent) 558c2ecf20Sopenharmony_ci{ 568c2ecf20Sopenharmony_ci struct list_head *ent, *n; 578c2ecf20Sopenharmony_ci struct w1_family *f; 588c2ecf20Sopenharmony_ci 598c2ecf20Sopenharmony_ci spin_lock(&w1_flock); 608c2ecf20Sopenharmony_ci list_for_each_safe(ent, n, &w1_families) { 618c2ecf20Sopenharmony_ci f = list_entry(ent, struct w1_family, family_entry); 628c2ecf20Sopenharmony_ci 638c2ecf20Sopenharmony_ci if (f->fid == fent->fid) { 648c2ecf20Sopenharmony_ci list_del(&fent->family_entry); 658c2ecf20Sopenharmony_ci break; 668c2ecf20Sopenharmony_ci } 678c2ecf20Sopenharmony_ci } 688c2ecf20Sopenharmony_ci spin_unlock(&w1_flock); 698c2ecf20Sopenharmony_ci 708c2ecf20Sopenharmony_ci /* deatch devices using this family code */ 718c2ecf20Sopenharmony_ci w1_reconnect_slaves(fent, 0); 728c2ecf20Sopenharmony_ci 738c2ecf20Sopenharmony_ci while (atomic_read(&fent->refcnt)) { 748c2ecf20Sopenharmony_ci pr_info("Waiting for family %u to become free: refcnt=%d.\n", 758c2ecf20Sopenharmony_ci fent->fid, atomic_read(&fent->refcnt)); 768c2ecf20Sopenharmony_ci 778c2ecf20Sopenharmony_ci if (msleep_interruptible(1000)) 788c2ecf20Sopenharmony_ci flush_signals(current); 798c2ecf20Sopenharmony_ci } 808c2ecf20Sopenharmony_ci} 818c2ecf20Sopenharmony_ciEXPORT_SYMBOL(w1_unregister_family); 828c2ecf20Sopenharmony_ci 838c2ecf20Sopenharmony_ci/* 848c2ecf20Sopenharmony_ci * Should be called under w1_flock held. 858c2ecf20Sopenharmony_ci */ 868c2ecf20Sopenharmony_cistruct w1_family * w1_family_registered(u8 fid) 878c2ecf20Sopenharmony_ci{ 888c2ecf20Sopenharmony_ci struct list_head *ent, *n; 898c2ecf20Sopenharmony_ci struct w1_family *f = NULL; 908c2ecf20Sopenharmony_ci int ret = 0; 918c2ecf20Sopenharmony_ci 928c2ecf20Sopenharmony_ci list_for_each_safe(ent, n, &w1_families) { 938c2ecf20Sopenharmony_ci f = list_entry(ent, struct w1_family, family_entry); 948c2ecf20Sopenharmony_ci 958c2ecf20Sopenharmony_ci if (f->fid == fid) { 968c2ecf20Sopenharmony_ci ret = 1; 978c2ecf20Sopenharmony_ci break; 988c2ecf20Sopenharmony_ci } 998c2ecf20Sopenharmony_ci } 1008c2ecf20Sopenharmony_ci 1018c2ecf20Sopenharmony_ci return (ret) ? f : NULL; 1028c2ecf20Sopenharmony_ci} 1038c2ecf20Sopenharmony_ci 1048c2ecf20Sopenharmony_cistatic void __w1_family_put(struct w1_family *f) 1058c2ecf20Sopenharmony_ci{ 1068c2ecf20Sopenharmony_ci atomic_dec(&f->refcnt); 1078c2ecf20Sopenharmony_ci} 1088c2ecf20Sopenharmony_ci 1098c2ecf20Sopenharmony_civoid w1_family_put(struct w1_family *f) 1108c2ecf20Sopenharmony_ci{ 1118c2ecf20Sopenharmony_ci spin_lock(&w1_flock); 1128c2ecf20Sopenharmony_ci __w1_family_put(f); 1138c2ecf20Sopenharmony_ci spin_unlock(&w1_flock); 1148c2ecf20Sopenharmony_ci} 1158c2ecf20Sopenharmony_ci 1168c2ecf20Sopenharmony_ci#if 0 1178c2ecf20Sopenharmony_civoid w1_family_get(struct w1_family *f) 1188c2ecf20Sopenharmony_ci{ 1198c2ecf20Sopenharmony_ci spin_lock(&w1_flock); 1208c2ecf20Sopenharmony_ci __w1_family_get(f); 1218c2ecf20Sopenharmony_ci spin_unlock(&w1_flock); 1228c2ecf20Sopenharmony_ci} 1238c2ecf20Sopenharmony_ci#endif /* 0 */ 1248c2ecf20Sopenharmony_ci 1258c2ecf20Sopenharmony_civoid __w1_family_get(struct w1_family *f) 1268c2ecf20Sopenharmony_ci{ 1278c2ecf20Sopenharmony_ci smp_mb__before_atomic(); 1288c2ecf20Sopenharmony_ci atomic_inc(&f->refcnt); 1298c2ecf20Sopenharmony_ci smp_mb__after_atomic(); 1308c2ecf20Sopenharmony_ci} 131