81 lines
		
	
	
		
			2.0 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			81 lines
		
	
	
		
			2.0 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
/*
 | 
						|
 * Stuff used by all variants of the driver
 | 
						|
 *
 | 
						|
 * Copyright (c) 2001 by Stefan Eilers,
 | 
						|
 *                       Hansjoerg Lipp <hjlipp@web.de>,
 | 
						|
 *                       Tilman Schmidt <tilman@imap.cc>.
 | 
						|
 *
 | 
						|
 * =====================================================================
 | 
						|
 *	This program is free software; you can redistribute it and/or
 | 
						|
 *	modify it under the terms of the GNU General Public License as
 | 
						|
 *	published by the Free Software Foundation; either version 2 of
 | 
						|
 *	the License, or (at your option) any later version.
 | 
						|
 * =====================================================================
 | 
						|
 */
 | 
						|
 | 
						|
#include "gigaset.h"
 | 
						|
 | 
						|
static ssize_t show_cidmode(struct device *dev,
 | 
						|
			    struct device_attribute *attr, char *buf)
 | 
						|
{
 | 
						|
	struct cardstate *cs = dev_get_drvdata(dev);
 | 
						|
 | 
						|
	return sprintf(buf, "%u\n", cs->cidmode);
 | 
						|
}
 | 
						|
 | 
						|
static ssize_t set_cidmode(struct device *dev, struct device_attribute *attr,
 | 
						|
			   const char *buf, size_t count)
 | 
						|
{
 | 
						|
	struct cardstate *cs = dev_get_drvdata(dev);
 | 
						|
	long int value;
 | 
						|
	char *end;
 | 
						|
 | 
						|
	value = simple_strtol(buf, &end, 0);
 | 
						|
	while (*end)
 | 
						|
		if (!isspace(*end++))
 | 
						|
			return -EINVAL;
 | 
						|
	if (value < 0 || value > 1)
 | 
						|
		return -EINVAL;
 | 
						|
 | 
						|
	if (mutex_lock_interruptible(&cs->mutex))
 | 
						|
		return -ERESTARTSYS;
 | 
						|
 | 
						|
	cs->waiting = 1;
 | 
						|
	if (!gigaset_add_event(cs, &cs->at_state, EV_PROC_CIDMODE,
 | 
						|
			       NULL, value, NULL)) {
 | 
						|
		cs->waiting = 0;
 | 
						|
		mutex_unlock(&cs->mutex);
 | 
						|
		return -ENOMEM;
 | 
						|
	}
 | 
						|
	gigaset_schedule_event(cs);
 | 
						|
 | 
						|
	wait_event(cs->waitqueue, !cs->waiting);
 | 
						|
 | 
						|
	mutex_unlock(&cs->mutex);
 | 
						|
 | 
						|
	return count;
 | 
						|
}
 | 
						|
 | 
						|
static DEVICE_ATTR(cidmode, S_IRUGO | S_IWUSR, show_cidmode, set_cidmode);
 | 
						|
 | 
						|
/* free sysfs for device */
 | 
						|
void gigaset_free_dev_sysfs(struct cardstate *cs)
 | 
						|
{
 | 
						|
	if (!cs->tty_dev)
 | 
						|
		return;
 | 
						|
 | 
						|
	gig_dbg(DEBUG_INIT, "removing sysfs entries");
 | 
						|
	device_remove_file(cs->tty_dev, &dev_attr_cidmode);
 | 
						|
}
 | 
						|
 | 
						|
/* initialize sysfs for device */
 | 
						|
void gigaset_init_dev_sysfs(struct cardstate *cs)
 | 
						|
{
 | 
						|
	if (!cs->tty_dev)
 | 
						|
		return;
 | 
						|
 | 
						|
	gig_dbg(DEBUG_INIT, "setting up sysfs");
 | 
						|
	if (device_create_file(cs->tty_dev, &dev_attr_cidmode))
 | 
						|
		pr_err("could not create sysfs attribute\n");
 | 
						|
}
 |