1*4882a593Smuzhiyun /* //device/system/reference-ril/at_tok.c
2*4882a593Smuzhiyun **
3*4882a593Smuzhiyun ** Copyright 2006, The Android Open Source Project
4*4882a593Smuzhiyun **
5*4882a593Smuzhiyun ** Licensed under the Apache License, Version 2.0 (the "License");
6*4882a593Smuzhiyun ** you may not use this file except in compliance with the License.
7*4882a593Smuzhiyun ** You may obtain a copy of the License at
8*4882a593Smuzhiyun **
9*4882a593Smuzhiyun ** http://www.apache.org/licenses/LICENSE-2.0
10*4882a593Smuzhiyun **
11*4882a593Smuzhiyun ** Unless required by applicable law or agreed to in writing, software
12*4882a593Smuzhiyun ** distributed under the License is distributed on an "AS IS" BASIS,
13*4882a593Smuzhiyun ** WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
14*4882a593Smuzhiyun ** See the License for the specific language governing permissions and
15*4882a593Smuzhiyun ** limitations under the License.
16*4882a593Smuzhiyun */
17*4882a593Smuzhiyun
18*4882a593Smuzhiyun #include "at_tok.h"
19*4882a593Smuzhiyun #include <string.h>
20*4882a593Smuzhiyun #include <ctype.h>
21*4882a593Smuzhiyun #include <stdlib.h>
22*4882a593Smuzhiyun
23*4882a593Smuzhiyun /**
24*4882a593Smuzhiyun * Starts tokenizing an AT response string
25*4882a593Smuzhiyun * returns -1 if this is not a valid response string, 0 on success.
26*4882a593Smuzhiyun * updates *p_cur with current position
27*4882a593Smuzhiyun */
at_tok_start(char ** p_cur)28*4882a593Smuzhiyun int at_tok_start(char **p_cur)
29*4882a593Smuzhiyun {
30*4882a593Smuzhiyun if (*p_cur == NULL) {
31*4882a593Smuzhiyun return -1;
32*4882a593Smuzhiyun }
33*4882a593Smuzhiyun
34*4882a593Smuzhiyun // skip prefix
35*4882a593Smuzhiyun // consume "^[^:]:"
36*4882a593Smuzhiyun
37*4882a593Smuzhiyun *p_cur = strchr(*p_cur, ':');
38*4882a593Smuzhiyun
39*4882a593Smuzhiyun if (*p_cur == NULL) {
40*4882a593Smuzhiyun return -1;
41*4882a593Smuzhiyun }
42*4882a593Smuzhiyun
43*4882a593Smuzhiyun (*p_cur)++;
44*4882a593Smuzhiyun
45*4882a593Smuzhiyun return 0;
46*4882a593Smuzhiyun }
47*4882a593Smuzhiyun
skipWhiteSpace(char ** p_cur)48*4882a593Smuzhiyun static void skipWhiteSpace(char **p_cur)
49*4882a593Smuzhiyun {
50*4882a593Smuzhiyun if (*p_cur == NULL) return;
51*4882a593Smuzhiyun
52*4882a593Smuzhiyun while (**p_cur != '\0' && isspace(**p_cur)) {
53*4882a593Smuzhiyun (*p_cur)++;
54*4882a593Smuzhiyun }
55*4882a593Smuzhiyun }
56*4882a593Smuzhiyun
skipNextComma(char ** p_cur)57*4882a593Smuzhiyun static void skipNextComma(char **p_cur)
58*4882a593Smuzhiyun {
59*4882a593Smuzhiyun if (*p_cur == NULL) return;
60*4882a593Smuzhiyun
61*4882a593Smuzhiyun while (**p_cur != '\0' && **p_cur != ',') {
62*4882a593Smuzhiyun (*p_cur)++;
63*4882a593Smuzhiyun }
64*4882a593Smuzhiyun
65*4882a593Smuzhiyun if (**p_cur == ',') {
66*4882a593Smuzhiyun (*p_cur)++;
67*4882a593Smuzhiyun }
68*4882a593Smuzhiyun }
69*4882a593Smuzhiyun
nextTok(char ** p_cur)70*4882a593Smuzhiyun static char * nextTok(char **p_cur)
71*4882a593Smuzhiyun {
72*4882a593Smuzhiyun char *ret = NULL;
73*4882a593Smuzhiyun
74*4882a593Smuzhiyun skipWhiteSpace(p_cur);
75*4882a593Smuzhiyun
76*4882a593Smuzhiyun if (*p_cur == NULL) {
77*4882a593Smuzhiyun ret = NULL;
78*4882a593Smuzhiyun } else if (**p_cur == '"') {
79*4882a593Smuzhiyun (*p_cur)++;
80*4882a593Smuzhiyun ret = strsep(p_cur, "\"");
81*4882a593Smuzhiyun skipNextComma(p_cur);
82*4882a593Smuzhiyun } else {
83*4882a593Smuzhiyun ret = strsep(p_cur, ",");
84*4882a593Smuzhiyun }
85*4882a593Smuzhiyun
86*4882a593Smuzhiyun return ret;
87*4882a593Smuzhiyun }
88*4882a593Smuzhiyun
89*4882a593Smuzhiyun
90*4882a593Smuzhiyun /**
91*4882a593Smuzhiyun * Parses the next integer in the AT response line and places it in *p_out
92*4882a593Smuzhiyun * returns 0 on success and -1 on fail
93*4882a593Smuzhiyun * updates *p_cur
94*4882a593Smuzhiyun * "base" is the same as the base param in strtol
95*4882a593Smuzhiyun */
96*4882a593Smuzhiyun
at_tok_nextint_base(char ** p_cur,int * p_out,int base,int uns)97*4882a593Smuzhiyun static int at_tok_nextint_base(char **p_cur, int *p_out, int base, int uns)
98*4882a593Smuzhiyun {
99*4882a593Smuzhiyun char *ret;
100*4882a593Smuzhiyun
101*4882a593Smuzhiyun if (*p_cur == NULL) {
102*4882a593Smuzhiyun return -1;
103*4882a593Smuzhiyun }
104*4882a593Smuzhiyun
105*4882a593Smuzhiyun ret = nextTok(p_cur);
106*4882a593Smuzhiyun
107*4882a593Smuzhiyun if (ret == NULL) {
108*4882a593Smuzhiyun return -1;
109*4882a593Smuzhiyun } else {
110*4882a593Smuzhiyun long l;
111*4882a593Smuzhiyun char *end;
112*4882a593Smuzhiyun
113*4882a593Smuzhiyun if (uns)
114*4882a593Smuzhiyun l = strtoul(ret, &end, base);
115*4882a593Smuzhiyun else
116*4882a593Smuzhiyun l = strtol(ret, &end, base);
117*4882a593Smuzhiyun
118*4882a593Smuzhiyun *p_out = (int)l;
119*4882a593Smuzhiyun
120*4882a593Smuzhiyun if (end == ret) {
121*4882a593Smuzhiyun return -1;
122*4882a593Smuzhiyun }
123*4882a593Smuzhiyun }
124*4882a593Smuzhiyun
125*4882a593Smuzhiyun return 0;
126*4882a593Smuzhiyun }
127*4882a593Smuzhiyun
128*4882a593Smuzhiyun /**
129*4882a593Smuzhiyun * Parses the next base 10 integer in the AT response line
130*4882a593Smuzhiyun * and places it in *p_out
131*4882a593Smuzhiyun * returns 0 on success and -1 on fail
132*4882a593Smuzhiyun * updates *p_cur
133*4882a593Smuzhiyun */
at_tok_nextint(char ** p_cur,int * p_out)134*4882a593Smuzhiyun int at_tok_nextint(char **p_cur, int *p_out)
135*4882a593Smuzhiyun {
136*4882a593Smuzhiyun return at_tok_nextint_base(p_cur, p_out, 10, 0);
137*4882a593Smuzhiyun }
138*4882a593Smuzhiyun
139*4882a593Smuzhiyun /**
140*4882a593Smuzhiyun * Parses the next base 16 integer in the AT response line
141*4882a593Smuzhiyun * and places it in *p_out
142*4882a593Smuzhiyun * returns 0 on success and -1 on fail
143*4882a593Smuzhiyun * updates *p_cur
144*4882a593Smuzhiyun */
at_tok_nexthexint(char ** p_cur,int * p_out)145*4882a593Smuzhiyun int at_tok_nexthexint(char **p_cur, int *p_out)
146*4882a593Smuzhiyun {
147*4882a593Smuzhiyun return at_tok_nextint_base(p_cur, p_out, 16, 1);
148*4882a593Smuzhiyun }
149*4882a593Smuzhiyun
at_tok_nextbool(char ** p_cur,char * p_out)150*4882a593Smuzhiyun int at_tok_nextbool(char **p_cur, char *p_out)
151*4882a593Smuzhiyun {
152*4882a593Smuzhiyun int ret;
153*4882a593Smuzhiyun int result;
154*4882a593Smuzhiyun
155*4882a593Smuzhiyun ret = at_tok_nextint(p_cur, &result);
156*4882a593Smuzhiyun
157*4882a593Smuzhiyun if (ret < 0) {
158*4882a593Smuzhiyun return -1;
159*4882a593Smuzhiyun }
160*4882a593Smuzhiyun
161*4882a593Smuzhiyun // booleans should be 0 or 1
162*4882a593Smuzhiyun if (!(result == 0 || result == 1)) {
163*4882a593Smuzhiyun return -1;
164*4882a593Smuzhiyun }
165*4882a593Smuzhiyun
166*4882a593Smuzhiyun if (p_out != NULL) {
167*4882a593Smuzhiyun *p_out = (char)result;
168*4882a593Smuzhiyun }
169*4882a593Smuzhiyun
170*4882a593Smuzhiyun return ret;
171*4882a593Smuzhiyun }
172*4882a593Smuzhiyun
at_tok_nextstr(char ** p_cur,char ** p_out)173*4882a593Smuzhiyun int at_tok_nextstr(char **p_cur, char **p_out)
174*4882a593Smuzhiyun {
175*4882a593Smuzhiyun if (*p_cur == NULL) {
176*4882a593Smuzhiyun return -1;
177*4882a593Smuzhiyun }
178*4882a593Smuzhiyun
179*4882a593Smuzhiyun *p_out = nextTok(p_cur);
180*4882a593Smuzhiyun
181*4882a593Smuzhiyun return 0;
182*4882a593Smuzhiyun }
183*4882a593Smuzhiyun
184*4882a593Smuzhiyun /** returns 1 on "has more tokens" and 0 if no */
at_tok_hasmore(char ** p_cur)185*4882a593Smuzhiyun int at_tok_hasmore(char **p_cur)
186*4882a593Smuzhiyun {
187*4882a593Smuzhiyun return ! (*p_cur == NULL || **p_cur == '\0');
188*4882a593Smuzhiyun }
189*4882a593Smuzhiyun
190*4882a593Smuzhiyun #if 1 //quectel
191*4882a593Smuzhiyun /**
192*4882a593Smuzhiyun * Add to skip comma
193*4882a593Smuzhiyun * Wythe 2013-9-27
194*4882a593Smuzhiyun */
skipComma(char ** p_cur)195*4882a593Smuzhiyun int skipComma(char **p_cur)
196*4882a593Smuzhiyun {
197*4882a593Smuzhiyun if(*p_cur == NULL) return -1;
198*4882a593Smuzhiyun
199*4882a593Smuzhiyun while(**p_cur != '\0' && **p_cur != ',')
200*4882a593Smuzhiyun {
201*4882a593Smuzhiyun (*p_cur)++;
202*4882a593Smuzhiyun }
203*4882a593Smuzhiyun
204*4882a593Smuzhiyun if(**p_cur == ',')
205*4882a593Smuzhiyun {
206*4882a593Smuzhiyun (*p_cur)++;
207*4882a593Smuzhiyun }
208*4882a593Smuzhiyun
209*4882a593Smuzhiyun if(*p_cur == NULL) return -1;
210*4882a593Smuzhiyun
211*4882a593Smuzhiyun
212*4882a593Smuzhiyun return 0;
213*4882a593Smuzhiyun }
214*4882a593Smuzhiyun
215*4882a593Smuzhiyun //wythe add on 2014-3-28
216*4882a593Smuzhiyun /** return the num of $(*target) char in $(*p_cur) string */
at_tok_charcounter(char * p_cur,char * target,int * p_outcount)217*4882a593Smuzhiyun int at_tok_charcounter(char *p_cur, char *target, int *p_outcount)
218*4882a593Smuzhiyun {
219*4882a593Smuzhiyun int targetcounter = 0;
220*4882a593Smuzhiyun
221*4882a593Smuzhiyun if(p_cur == NULL)
222*4882a593Smuzhiyun return -1;
223*4882a593Smuzhiyun
224*4882a593Smuzhiyun while(*p_cur != '\0')
225*4882a593Smuzhiyun {
226*4882a593Smuzhiyun if( *p_cur == *target)
227*4882a593Smuzhiyun targetcounter++;
228*4882a593Smuzhiyun p_cur++;
229*4882a593Smuzhiyun }
230*4882a593Smuzhiyun *p_outcount=targetcounter;
231*4882a593Smuzhiyun return 0;
232*4882a593Smuzhiyun }
233*4882a593Smuzhiyun
234*4882a593Smuzhiyun //wythe add on 2014-3-28
235*4882a593Smuzhiyun /** return the element value between beginTag and endTag,
236*4882a593Smuzhiyun * also return the new string begin from endTag.(endTag is
237*4882a593Smuzhiyun * not in the new string)
238*4882a593Smuzhiyun */
at_tok_getElementValue(const char * p_in,const char * beginTag,const char * endTag,char ** remaining)239*4882a593Smuzhiyun char* at_tok_getElementValue(const char *p_in, const char *beginTag, const char *endTag, char **remaining)
240*4882a593Smuzhiyun {
241*4882a593Smuzhiyun char *ret = NULL;
242*4882a593Smuzhiyun char *start = NULL;
243*4882a593Smuzhiyun char *end = NULL;
244*4882a593Smuzhiyun int n = 0;
245*4882a593Smuzhiyun int m = 0;
246*4882a593Smuzhiyun
247*4882a593Smuzhiyun if(p_in == NULL || beginTag == NULL || endTag == NULL)
248*4882a593Smuzhiyun return NULL;
249*4882a593Smuzhiyun
250*4882a593Smuzhiyun start = strstr(p_in, beginTag);
251*4882a593Smuzhiyun if(start != NULL)
252*4882a593Smuzhiyun end = strstr(p_in,endTag);
253*4882a593Smuzhiyun if(end != NULL)
254*4882a593Smuzhiyun {
255*4882a593Smuzhiyun n = strlen(beginTag);
256*4882a593Smuzhiyun m = end - (start+n);
257*4882a593Smuzhiyun
258*4882a593Smuzhiyun ret = (char *)malloc(m * sizeof(char *));
259*4882a593Smuzhiyun if(ret != NULL)
260*4882a593Smuzhiyun {
261*4882a593Smuzhiyun strncpy(ret, start+n, m);
262*4882a593Smuzhiyun ret[m] = (char)0;
263*4882a593Smuzhiyun }
264*4882a593Smuzhiyun
265*4882a593Smuzhiyun if(remaining != NULL)
266*4882a593Smuzhiyun *remaining = end + strlen(endTag);
267*4882a593Smuzhiyun }
268*4882a593Smuzhiyun
269*4882a593Smuzhiyun return ret;
270*4882a593Smuzhiyun }
271*4882a593Smuzhiyun #endif
272*4882a593Smuzhiyun
273