hc
2023-11-06 e3e12f52b214121840b44c91de5b3e5af5d3eb84
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
/*
 * 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");
}