| Hansjoerg Lipp | 982da5a | 2006-03-26 01:38:33 -0800 | [diff] [blame] | 1 | /* | 
 | 2 |  * Stuff used by all variants of the driver | 
 | 3 |  * | 
| Tilman Schmidt | 70440cf | 2006-04-10 22:55:14 -0700 | [diff] [blame] | 4 |  * Copyright (c) 2001 by Stefan Eilers, | 
| Hansjoerg Lipp | 982da5a | 2006-03-26 01:38:33 -0800 | [diff] [blame] | 5 |  *                       Hansjoerg Lipp <hjlipp@web.de>, | 
 | 6 |  *                       Tilman Schmidt <tilman@imap.cc>. | 
 | 7 |  * | 
 | 8 |  * ===================================================================== | 
 | 9 |  *	This program is free software; you can redistribute it and/or | 
 | 10 |  *	modify it under the terms of the GNU General Public License as | 
 | 11 |  *	published by the Free Software Foundation; either version 2 of | 
 | 12 |  *	the License, or (at your option) any later version. | 
 | 13 |  * ===================================================================== | 
| Hansjoerg Lipp | 982da5a | 2006-03-26 01:38:33 -0800 | [diff] [blame] | 14 |  */ | 
 | 15 |  | 
 | 16 | #include "gigaset.h" | 
 | 17 | #include <linux/ctype.h> | 
 | 18 |  | 
| Greg Kroah-Hartman | 01107d3 | 2006-08-07 22:19:37 -0700 | [diff] [blame] | 19 | static ssize_t show_cidmode(struct device *dev, | 
 | 20 | 			    struct device_attribute *attr, char *buf) | 
| Hansjoerg Lipp | 982da5a | 2006-03-26 01:38:33 -0800 | [diff] [blame] | 21 | { | 
| Greg Kroah-Hartman | 01107d3 | 2006-08-07 22:19:37 -0700 | [diff] [blame] | 22 | 	struct cardstate *cs = dev_get_drvdata(dev); | 
| Tilman Schmidt | 69049cc | 2006-04-10 22:55:16 -0700 | [diff] [blame] | 23 |  | 
| Tilman Schmidt | 4d1ff58 | 2007-10-16 01:27:50 -0700 | [diff] [blame] | 24 | 	return sprintf(buf, "%u\n", cs->cidmode); | 
| Hansjoerg Lipp | 982da5a | 2006-03-26 01:38:33 -0800 | [diff] [blame] | 25 | } | 
 | 26 |  | 
| Greg Kroah-Hartman | 01107d3 | 2006-08-07 22:19:37 -0700 | [diff] [blame] | 27 | static ssize_t set_cidmode(struct device *dev, struct device_attribute *attr, | 
| Tilman Schmidt | 917f508 | 2006-04-10 22:55:00 -0700 | [diff] [blame] | 28 | 			   const char *buf, size_t count) | 
| Hansjoerg Lipp | 982da5a | 2006-03-26 01:38:33 -0800 | [diff] [blame] | 29 | { | 
| Greg Kroah-Hartman | 01107d3 | 2006-08-07 22:19:37 -0700 | [diff] [blame] | 30 | 	struct cardstate *cs = dev_get_drvdata(dev); | 
| Hansjoerg Lipp | 982da5a | 2006-03-26 01:38:33 -0800 | [diff] [blame] | 31 | 	long int value; | 
 | 32 | 	char *end; | 
 | 33 |  | 
 | 34 | 	value = simple_strtol(buf, &end, 0); | 
 | 35 | 	while (*end) | 
 | 36 | 		if (!isspace(*end++)) | 
 | 37 | 			return -EINVAL; | 
 | 38 | 	if (value < 0 || value > 1) | 
 | 39 | 			return -EINVAL; | 
 | 40 |  | 
| Tilman Schmidt | abfd1dc | 2006-04-10 22:55:12 -0700 | [diff] [blame] | 41 | 	if (mutex_lock_interruptible(&cs->mutex)) | 
| Hansjoerg Lipp | 982da5a | 2006-03-26 01:38:33 -0800 | [diff] [blame] | 42 | 		return -ERESTARTSYS; // FIXME -EINTR? | 
 | 43 |  | 
 | 44 | 	cs->waiting = 1; | 
 | 45 | 	if (!gigaset_add_event(cs, &cs->at_state, EV_PROC_CIDMODE, | 
| Tilman Schmidt | 784d585 | 2006-04-10 22:55:04 -0700 | [diff] [blame] | 46 | 			       NULL, value, NULL)) { | 
| Hansjoerg Lipp | 982da5a | 2006-03-26 01:38:33 -0800 | [diff] [blame] | 47 | 		cs->waiting = 0; | 
| Tilman Schmidt | abfd1dc | 2006-04-10 22:55:12 -0700 | [diff] [blame] | 48 | 		mutex_unlock(&cs->mutex); | 
| Hansjoerg Lipp | 982da5a | 2006-03-26 01:38:33 -0800 | [diff] [blame] | 49 | 		return -ENOMEM; | 
 | 50 | 	} | 
 | 51 |  | 
| Tilman Schmidt | 784d585 | 2006-04-10 22:55:04 -0700 | [diff] [blame] | 52 | 	gig_dbg(DEBUG_CMD, "scheduling PROC_CIDMODE"); | 
| Hansjoerg Lipp | 982da5a | 2006-03-26 01:38:33 -0800 | [diff] [blame] | 53 | 	gigaset_schedule_event(cs); | 
 | 54 |  | 
 | 55 | 	wait_event(cs->waitqueue, !cs->waiting); | 
 | 56 |  | 
| Tilman Schmidt | abfd1dc | 2006-04-10 22:55:12 -0700 | [diff] [blame] | 57 | 	mutex_unlock(&cs->mutex); | 
| Hansjoerg Lipp | 982da5a | 2006-03-26 01:38:33 -0800 | [diff] [blame] | 58 |  | 
 | 59 | 	return count; | 
 | 60 | } | 
 | 61 |  | 
| Greg Kroah-Hartman | 01107d3 | 2006-08-07 22:19:37 -0700 | [diff] [blame] | 62 | static DEVICE_ATTR(cidmode, S_IRUGO|S_IWUSR, show_cidmode, set_cidmode); | 
| Hansjoerg Lipp | 982da5a | 2006-03-26 01:38:33 -0800 | [diff] [blame] | 63 |  | 
 | 64 | /* free sysfs for device */ | 
| Tilman Schmidt | b1d4746 | 2006-04-10 22:55:07 -0700 | [diff] [blame] | 65 | void gigaset_free_dev_sysfs(struct cardstate *cs) | 
| Hansjoerg Lipp | 982da5a | 2006-03-26 01:38:33 -0800 | [diff] [blame] | 66 | { | 
| Greg Kroah-Hartman | 01107d3 | 2006-08-07 22:19:37 -0700 | [diff] [blame] | 67 | 	if (!cs->tty_dev) | 
| Hansjoerg Lipp | 3dda4e3 | 2006-04-22 18:43:00 +0200 | [diff] [blame] | 68 | 		return; | 
 | 69 |  | 
| Tilman Schmidt | 784d585 | 2006-04-10 22:55:04 -0700 | [diff] [blame] | 70 | 	gig_dbg(DEBUG_INIT, "removing sysfs entries"); | 
| Greg Kroah-Hartman | 01107d3 | 2006-08-07 22:19:37 -0700 | [diff] [blame] | 71 | 	device_remove_file(cs->tty_dev, &dev_attr_cidmode); | 
| Hansjoerg Lipp | 982da5a | 2006-03-26 01:38:33 -0800 | [diff] [blame] | 72 | } | 
| Hansjoerg Lipp | 982da5a | 2006-03-26 01:38:33 -0800 | [diff] [blame] | 73 |  | 
 | 74 | /* initialize sysfs for device */ | 
| Tilman Schmidt | b1d4746 | 2006-04-10 22:55:07 -0700 | [diff] [blame] | 75 | void gigaset_init_dev_sysfs(struct cardstate *cs) | 
| Hansjoerg Lipp | 982da5a | 2006-03-26 01:38:33 -0800 | [diff] [blame] | 76 | { | 
| Greg Kroah-Hartman | 01107d3 | 2006-08-07 22:19:37 -0700 | [diff] [blame] | 77 | 	if (!cs->tty_dev) | 
| Hansjoerg Lipp | 3dda4e3 | 2006-04-22 18:43:00 +0200 | [diff] [blame] | 78 | 		return; | 
 | 79 |  | 
| Tilman Schmidt | 784d585 | 2006-04-10 22:55:04 -0700 | [diff] [blame] | 80 | 	gig_dbg(DEBUG_INIT, "setting up sysfs"); | 
| Greg Kroah-Hartman | 01107d3 | 2006-08-07 22:19:37 -0700 | [diff] [blame] | 81 | 	if (device_create_file(cs->tty_dev, &dev_attr_cidmode)) | 
| Tilman Schmidt | fd0fbcc | 2006-10-02 02:17:37 -0700 | [diff] [blame] | 82 | 		dev_err(cs->dev, "could not create sysfs attribute\n"); | 
| Hansjoerg Lipp | 982da5a | 2006-03-26 01:38:33 -0800 | [diff] [blame] | 83 | } |