w1.c

来自「Linux Kernel 2.6.9 for OMAP1710」· C语言 代码 · 共 802 行 · 第 1/2 页

C
802 行
字号
	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);	init_completion(&sl->dev_released);	spin_lock(&w1_flock);	f = w1_family_registered(rn->family);	if (!f) {		spin_unlock(&w1_flock);		dev_info(&dev->dev, "Family %x for %02x.%012llx.%02x is not registered.\n",			  rn->family, rn->family, rn->id, rn->crc);		kfree(sl);		return -ENODEV;	}	__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;	}	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;		dev_info(&sl->dev, "%s: detaching %s.\n", __func__, sl->name);	while (atomic_read(&sl->refcnt))		schedule_timeout(10);	sysfs_remove_bin_file (&sl->dev.kobj, &sl->attr_bin);	device_remove_file(&sl->dev, &sl->attr_name);	device_remove_file(&sl->dev, &sl->attr_val);	device_unregister(&sl->dev);	w1_family_put(sl->family);	memcpy(&msg.id.id, &sl->reg_num, sizeof(msg.id.id));	msg.type = W1_SLAVE_REMOVE;	w1_netlink_send(sl->master, &msg);}static void w1_search(struct w1_master *dev){	u64 last, rn, tmp;	int i, count = 0, slave_count;	int last_family_desc, last_zero, last_device;	int search_bit, id_bit, comp_bit, desc_bit;	struct list_head *ent;	struct w1_slave *sl;	int family_found = 0;	dev->attempts++;	search_bit = id_bit = comp_bit = 0;	rn = tmp = last = 0;	last_device = last_zero = last_family_desc = 0;	desc_bit = 64;	while (!(id_bit && comp_bit) && !last_device		&& count++ < dev->max_slave_count) {		last = rn;		rn = 0;		last_family_desc = 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)) {			dev_info(&dev->dev, "No devices present on the wire.\n");			break;		}#if 1		w1_write_8(dev, W1_SEARCH);		for (i = 0; i < 64; ++i) {			/*			 * Read 2 bits from bus.			 * All who don't sleep must send ID bit and COMPLEMENT ID bit.			 * They actually are ANDed between all senders.			 */			id_bit = w1_read_bit(dev);			comp_bit = w1_read_bit(dev);			if (id_bit && comp_bit)				break;			if (id_bit == 0 && comp_bit == 0) {				if (i == desc_bit)					search_bit = 1;				else if (i > desc_bit)					search_bit = 0;				else					search_bit = ((last >> i) & 0x1);				if (search_bit == 0) {					last_zero = i;					if (last_zero < 9)						last_family_desc = last_zero;				}			}			else				search_bit = id_bit;			tmp = search_bit;			rn |= (tmp << i);			/*			 * Write 1 bit to bus			 * and make all who don't have "search_bit" in "i"'th position			 * in it's registration number sleep.			 */			w1_write_bit(dev, search_bit);		}#endif		if (desc_bit == last_zero)			last_device = 1;		desc_bit = last_zero;		slave_count = 0;		list_for_each(ent, &dev->slist) {			struct w1_reg_num *tmp;			tmp = (struct w1_reg_num *) &rn;			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;			}			else if (sl->reg_num.family == tmp->family) {				family_found = 1;				break;			}			slave_count++;		}		if (slave_count == dev->slave_count &&		    ((rn >> 56) & 0xff) == w1_calc_crc8((u8 *)&rn, 7)) {			w1_attach_slave_device(dev, (struct w1_reg_num *) &rn);		}	}}int w1_create_master_attributes(struct w1_master *dev){	if (	device_create_file(&dev->dev, &w1_master_attribute_slaves) < 0 ||		device_create_file(&dev->dev, &w1_master_attribute_slave_count) < 0 ||		device_create_file(&dev->dev, &w1_master_attribute_attempts) < 0 ||		device_create_file(&dev->dev, &w1_master_attribute_max_slave_count) < 0 ||		device_create_file(&dev->dev, &w1_master_attribute_timeout) < 0||		device_create_file(&dev->dev, &w1_master_attribute_pointer) < 0||		device_create_file(&dev->dev, &w1_master_attribute_name) < 0)		return -EINVAL;	return 0;}void w1_destroy_master_attributes(struct w1_master *dev){	device_remove_file(&dev->dev, &w1_master_attribute_slaves);	device_remove_file(&dev->dev, &w1_master_attribute_slave_count);	device_remove_file(&dev->dev, &w1_master_attribute_attempts);	device_remove_file(&dev->dev, &w1_master_attribute_max_slave_count);	device_remove_file(&dev->dev, &w1_master_attribute_timeout);	device_remove_file(&dev->dev, &w1_master_attribute_pointer);	device_remove_file(&dev->dev, &w1_master_attribute_name);}int w1_control(void *data){	struct w1_slave *sl;	struct w1_master *dev;	struct list_head *ent, *ment, *n, *mn;	int err, have_to_wait = 0, timeout;	daemonize("w1_control");	allow_signal(SIGTERM);	while (!control_needs_exit || have_to_wait) {		have_to_wait = 0;		timeout = w1_timeout*HZ;		do {			timeout = interruptible_sleep_on_timeout(&w1_control_wait, timeout);			if (current->flags & PF_FREEZE)				refrigerator(PF_FREEZE);		} while (!signal_pending(current) && (timeout > 0));		if (signal_pending(current))			flush_signals(current);		list_for_each_safe(ment, mn, &w1_masters) {			dev = list_entry(ment, struct w1_master, w1_master_entry);			if (!control_needs_exit && !dev->need_exit)				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;			}			spin_lock(&w1_mlock);			list_del(&dev->w1_master_entry);			spin_unlock(&w1_mlock);			if (control_needs_exit) {				dev->need_exit = 1;				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);			}			wait_for_completion(&dev->dev_exited);			list_for_each_safe(ent, n, &dev->slist) {				sl = list_entry(ent, struct w1_slave, w1_slave_entry);				if (!sl)					dev_warn(&dev->dev,						  "%s: slave entry is NULL.\n",						  __func__);				else {					list_del(&sl->w1_slave_entry);					w1_slave_detach(sl);					kfree(sl);				}			}			w1_destroy_master_attributes(dev);			atomic_dec(&dev->refcnt);		}	}	complete_and_exit(&w1_control_complete, 0);}int w1_process(void *data){	struct w1_master *dev = (struct w1_master *) data;	unsigned long timeout;	struct list_head *ent, *n;	struct w1_slave *sl;	daemonize("%s", dev->name);	allow_signal(SIGTERM);	while (!dev->need_exit) {		timeout = w1_timeout*HZ;		do {			timeout = interruptible_sleep_on_timeout(&dev->kwait, timeout);			if (current->flags & PF_FREEZE)				refrigerator(PF_FREEZE);		} while (!signal_pending(current) && (timeout > 0));		if (signal_pending(current))			flush_signals(current);		if (dev->need_exit)			break;		if (!dev->initialized)			continue;		if (down_interruptible(&dev->mutex))			continue;		list_for_each_safe(ent, n, &dev->slist) {			sl = list_entry(ent, struct w1_slave, w1_slave_entry);			if (sl)				clear_bit(W1_SLAVE_ACTIVE, (long *)&sl->flags);		}		      		w1_search(dev);				list_for_each_safe(ent, n, &dev->slist) {			sl = list_entry(ent, struct w1_slave, w1_slave_entry);			if (sl && !test_bit(W1_SLAVE_ACTIVE, (unsigned long *)&sl->flags)) {				list_del (&sl->w1_slave_entry);				w1_slave_detach (sl);				kfree (sl);				dev->slave_count--;			}		}		up(&dev->mutex);	}	atomic_dec(&dev->refcnt);	complete_and_exit(&dev->dev_exited, 0);	return 0;}int w1_init(void){	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;	}	retval = driver_register(&w1_driver);	if (retval) {		printk(KERN_ERR			"Failed to register master driver. err=%d.\n",			retval);		goto err_out_bus_unregister;	}	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;		goto err_out_driver_unregister;	}	return 0;err_out_driver_unregister:	driver_unregister(&w1_driver);err_out_bus_unregister:	bus_unregister(&w1_bus_type);err_out_exit_init:	return retval;}void w1_fini(void){	struct w1_master *dev;	struct list_head *ent, *n;	list_for_each_safe(ent, n, &w1_masters) {		dev = list_entry(ent, struct w1_master, w1_master_entry);		__w1_remove_master_device(dev);	}	control_needs_exit = 1;	wait_for_completion(&w1_control_complete);	driver_unregister(&w1_driver);	bus_unregister(&w1_bus_type);}module_init(w1_init);module_exit(w1_fini);EXPORT_SYMBOL(w1_create_master_attributes);EXPORT_SYMBOL(w1_destroy_master_attributes);

⌨️ 快捷键说明

复制代码Ctrl + C
搜索代码Ctrl + F
全屏模式F11
增大字号Ctrl + =
减小字号Ctrl + -
显示快捷键?