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
105
106
107
108
109
|
#include <stdlib.h>
#include <unistd.h>
#include <string.h>
#include <stdio.h>
#include <errno.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_WAKEUP_TIMEOUT 3
static int null_wakeup_cb(struct gsmd_atcmd *cmd, void *ctx, char *resp)
{
DEBUGP("The wake up callback!!\n");
return 0;
}
static void wakeup_timeout(struct gsmd_timer *tmr, void *data)
{
struct gsmd *g=data;
struct gsmd_atcmd *cmd=NULL;
DEBUGP("Wakeup time out!!\n");
if (!llist_empty(&g->busy_atcmds)) {
cmd = llist_entry(g->busy_atcmds.next,struct gsmd_atcmd, list);
}
if (!cmd) {
DEBUGP("ERROR!! busy_atcmds is NULL\n");
return;
}
if (cmd->timeout != tmr) {
DEBUGP("ERROR!! cmd->timeout != tmr\n");
return;
}
gsmd_timer_free(cmd->timeout);
cmd->timeout = NULL;
// It's a wakeup command
if ( cmd->buf[0]==' ') {
llist_del(&cmd->list);
talloc_free(cmd);
// discard the wakeup command, and pass the real command.
if (llist_empty(&g->busy_atcmds) && !llist_empty(&g->pending_atcmds)) {
atcmd_wake_pending_queue(g);
}
} else {
DEBUGP("ERROR!! Wakeup timeout and cmd->buf is not wakeup command!! %s\n",cmd->buf);
}
}
static struct gsmd_timer * wakeup_timer(struct gsmd *g)
{
struct timeval tv;
tv.tv_sec = GSMD_MODEM_WAKEUP_TIMEOUT;
tv.tv_usec = 0;
DEBUGP("Create wake up timer\n");
return gsmd_timer_create(&tv,&wakeup_timeout,g);
}
/// adding a null '\r' before real at command.
static int atcmd_wakeup_modem(struct gsmd *g)
{
DEBUGP("try to wake up\n");
struct gsmd_atcmd * cmd= atcmd_fill(" \r", 2, null_wakeup_cb, g, 0, wakeup_timer);
llist_add_tail(&cmd->list, &g->pending_atcmds);
if (llist_empty(&g->busy_atcmds) && !llist_empty(&g->pending_atcmds)) {
atcmd_wake_pending_queue(g);
}
return 0;
}
static int gta01_detect(struct gsmd *g)
{
/* FIXME: do actual detection of machine if we have multiple machines */
return 1;
}
static int gta01_init(struct gsmd *g, int fd)
{
int rc;
/*
* We assume that the GSM chipset can take
* input immediately, so we don't have to
* wait for the "AT-Command Interpreter ready"
* message before trying to send commands.
*/
g->interpreter_ready = 1;
return 0;
}
struct gsmd_machine_plugin gsmd_machine_plugin = {
.name = "TI Calypso / FIC firmware",
.ex_submit = &atcmd_wakeup_modem,
.detect = >a01_detect,
.init = >a01_init,
};
|