w1_family.c revision 70d484bff43013e9b08f5d970b1c5941e9d98e16
11da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/*
27785925dd8e0d2f389d4a9168f1683c6b249a552Evgeniy Polyakov *	w1_family.c
31da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds *
41da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Copyright (c) 2004 Evgeniy Polyakov <johnpol@2ka.mipt.ru>
57785925dd8e0d2f389d4a9168f1683c6b249a552Evgeniy Polyakov *
61da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds *
71da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * This program is free software; you can redistribute it and/or modify
81da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * it under the terms of the GNU General Public License as published by
91da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * the Free Software Foundation; either version 2 of the License, or
101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * (at your option) any later version.
111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds *
121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * This program is distributed in the hope that it will be useful,
131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * but WITHOUT ANY WARRANTY; without even the implied warranty of
141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * GNU General Public License for more details.
161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds *
171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * You should have received a copy of the GNU General Public License
181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * along with this program; if not, write to the Free Software
191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */
211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds
221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/spinlock.h>
231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/list.h>
244e57b6817880946a3a78d5d8cad1ace363f7e449Tim Schmielau#include <linux/sched.h>	/* schedule_timeout() */
251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/delay.h>
261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds
271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include "w1_family.h"
28a9fb1c7b950bed4afe208c9d67e20f086bb6abbbAdrian Bunk#include "w1.h"
291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds
301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus TorvaldsDEFINE_SPINLOCK(w1_flock);
311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic LIST_HEAD(w1_families);
321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds
331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsint w1_register_family(struct w1_family *newf)
341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{
351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	struct list_head *ent, *n;
361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	struct w1_family *f;
371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	int ret = 0;
381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds
391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	spin_lock(&w1_flock);
401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	list_for_each_safe(ent, n, &w1_families) {
411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		f = list_entry(ent, struct w1_family, family_entry);
421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds
431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		if (f->fid == newf->fid) {
441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds			ret = -EEXIST;
451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds			break;
461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		}
471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	}
481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds
491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	if (!ret) {
501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		atomic_set(&newf->refcnt, 0);
511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		newf->need_exit = 0;
521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		list_add_tail(&newf->family_entry, &w1_families);
531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	}
541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	spin_unlock(&w1_flock);
551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds
566adf87bd7b7832105b9c6bc08adf6a4d229f1e79Evgeniy Polyakov	w1_reconnect_slaves(newf);
576adf87bd7b7832105b9c6bc08adf6a4d229f1e79Evgeniy Polyakov
581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	return ret;
591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}
601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds
611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsvoid w1_unregister_family(struct w1_family *fent)
621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{
631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	struct list_head *ent, *n;
641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	struct w1_family *f;
651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds
661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	spin_lock(&w1_flock);
671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	list_for_each_safe(ent, n, &w1_families) {
681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		f = list_entry(ent, struct w1_family, family_entry);
691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds
701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		if (f->fid == fent->fid) {
711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds			list_del(&fent->family_entry);
721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds			break;
731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		}
741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	}
751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds
761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	fent->need_exit = 1;
771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds
781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	spin_unlock(&w1_flock);
791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds
801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	while (atomic_read(&fent->refcnt)) {
811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		printk(KERN_INFO "Waiting for family %u to become free: refcnt=%d.\n",
821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds				fent->fid, atomic_read(&fent->refcnt));
831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds
841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		if (msleep_interruptible(1000))
851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds			flush_signals(current);
861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	}
871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}
881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds
891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/*
901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Should be called under w1_flock held.
911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */
921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstruct w1_family * w1_family_registered(u8 fid)
931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{
941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	struct list_head *ent, *n;
951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	struct w1_family *f = NULL;
961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	int ret = 0;
971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds
981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	list_for_each_safe(ent, n, &w1_families) {
991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		f = list_entry(ent, struct w1_family, family_entry);
1001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds
1011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		if (f->fid == fid) {
1021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds			ret = 1;
1031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds			break;
1041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds		}
1051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	}
1061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds
1071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	return (ret) ? f : NULL;
1081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}
1091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds
11070d484bff43013e9b08f5d970b1c5941e9d98e16Evgeniy Polyakovstatic void __w1_family_put(struct w1_family *f)
11170d484bff43013e9b08f5d970b1c5941e9d98e16Evgeniy Polyakov{
11270d484bff43013e9b08f5d970b1c5941e9d98e16Evgeniy Polyakov	if (atomic_dec_and_test(&f->refcnt))
11370d484bff43013e9b08f5d970b1c5941e9d98e16Evgeniy Polyakov		f->need_exit = 1;
11470d484bff43013e9b08f5d970b1c5941e9d98e16Evgeniy Polyakov}
11570d484bff43013e9b08f5d970b1c5941e9d98e16Evgeniy Polyakov
1161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsvoid w1_family_put(struct w1_family *f)
1171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{
1181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	spin_lock(&w1_flock);
1191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	__w1_family_put(f);
1201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	spin_unlock(&w1_flock);
1211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}
1221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds
12370d484bff43013e9b08f5d970b1c5941e9d98e16Evgeniy Polyakov#if 0
1241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsvoid w1_family_get(struct w1_family *f)
1251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{
1261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	spin_lock(&w1_flock);
1271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	__w1_family_get(f);
1281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	spin_unlock(&w1_flock);
1291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}
13070d484bff43013e9b08f5d970b1c5941e9d98e16Evgeniy Polyakov#endif  /*  0  */
1311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds
1321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsvoid __w1_family_get(struct w1_family *f)
1331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{
1341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	smp_mb__before_atomic_inc();
1351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	atomic_inc(&f->refcnt);
1361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds	smp_mb__after_atomic_inc();
1371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}
1381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds
1391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus TorvaldsEXPORT_SYMBOL(w1_unregister_family);
1401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus TorvaldsEXPORT_SYMBOL(w1_register_family);
141