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
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
|
/* Telit GM862 / RS323 machine plugin
*
* (c) 2008 Florian Boor <florian@kernelconcepts.de>
*
* 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.
*
* This program is distributed in the hope that it will be useful,
* but WITHOUT ANY WARRANTY; without even the implied warranty of
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
* GNU General Public License for more details.
*
* You should have received a copy of the GNU General Public License along
* with this program; if not, write to the Free Software Foundation, Inc.,
* 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
*
*/
#include <stdlib.h>
#include <unistd.h>
#include <string.h>
#include <stdio.h>
#include <errno.h>
#include <sys/ioctl.h>
#include "gsmd.h"
#include <gsmd/gsmd.h>
#include <gsmd/usock.h>
#include <gsmd/event.h>
#include <gsmd/talloc.h>
#include <gsmd/extrsp.h>
#include <gsmd/machineplugin.h>
#include <gsmd/atcmd.h>
#define GSMD_MODEM_POWEROFF_TIMEOUT 6
static void poweroff_timeout(struct gsmd_timer *tmr, void *data)
{
exit(0);
}
static struct gsmd_timer *poweroff_timer(struct gsmd *g)
{
struct timeval tv;
tv.tv_sec = GSMD_MODEM_POWEROFF_TIMEOUT;
tv.tv_usec = 0;
DEBUGP("Create power off timer\n");
return gsmd_timer_create(&tv, &poweroff_timeout, g);
}
static int telit_detect(struct gsmd *g)
{
return 1; /* not yet implemented */
}
static int telit_init(struct gsmd *g, int fd)
{
/* We assume the modem has been turned on manually using the S3
baseboard or on device startup. */
g->interpreter_ready = 1;
return 0;
}
static int telit_power(struct gsmd *g, int power)
{
struct gsmd_atcmd *cmd = NULL;
switch (power) {
case GSMD_MODEM_POWERUP:
break;
case GSMD_MODEM_POWERDOWN:
cmd = atcmd_fill("AT#SHDN", 7 + 1, NULL,
g, 0, poweroff_timer);
if (!cmd)
return -ENOMEM;
llist_add_tail(&cmd->list, &g->pending_atcmds);
if (llist_empty(&g->busy_atcmds) &&
!llist_empty(&g->pending_atcmds)) {
atcmd_wake_pending_queue(g);
}
break;
default:
return -EINVAL;
}
return 0;
}
struct gsmd_machine_plugin gsmd_machine_plugin = {
.name = "Telit GM862",
.power = telit_power,
.ex_submit = NULL,
.detect = &telit_detect,
.init = &telit_init,
};
|
