comparison rvinterf/tmsh/ffs2wr.c @ 0:e7502631a0f9

initial import from freecalypso-sw rev 1033:5ab737ac3ad7
author Mychaela Falconia <falcon@freecalypso.org>
date Sat, 11 Jun 2016 00:13:35 +0000
parents
children
comparison
equal deleted inserted replaced
-1:000000000000 0:e7502631a0f9
1 /*
2 * In this module we are going to implement some high-level FFS write
3 * operations, using the TMFFS2 protocol.
4 */
5
6 #include <sys/types.h>
7 #include <ctype.h>
8 #include <stdio.h>
9 #include <string.h>
10 #include <strings.h>
11 #include <stdlib.h>
12 #include "limits.h"
13 #include "localtypes.h"
14 #include "etm.h"
15 #include "ffs.h"
16 #include "tmffs2.h"
17
18 void
19 send_file_write(filename, data, size)
20 char *filename;
21 u_char *data;
22 {
23 u_char cmdpkt[MAX_PKT_TO_TARGET], *dp;
24
25 dp = cmdpkt + 1;
26 *dp++ = ETM_FFS2;
27 *dp++ = TMFFS_FILE_WRITE;
28 *dp++ = strlen(filename) + 1;
29 strcpy(dp, filename);
30 dp += strlen(filename) + 1;
31 *dp++ = size; /* data size in bytes */
32 bcopy(data, dp, size);
33 dp += size;
34 *dp++ = FFS_O_CREATE | FFS_O_TRUNC;
35 send_etm_cmd(cmdpkt, dp - cmdpkt - 1);
36 }
37
38 void
39 cmd_set_imeisv(argc, argv)
40 char **argv;
41 {
42 char *filename, *cp, digits[16];
43 u_char bytes[8];
44 int pcm_order, i;
45
46 if (!strcmp(argv[1], "pcm")) {
47 filename = "/pcm/IMEI";
48 pcm_order = 1;
49 } else if (!strcmp(argv[1], "fc")) {
50 filename = "/etc/IMEISV";
51 pcm_order = 0;
52 } else {
53 printf(
54 "error: IMEISV storage type argument must be \"pcm\" or \"fc\"\n");
55 return;
56 }
57 cp = argv[2];
58 if (!isdigit(*cp)) {
59 inv: printf("error: 2nd argument must have 16 decimal digits\n");
60 return;
61 }
62 for (i = 0; i < 16; i++) {
63 if (ispunct(*cp))
64 cp++;
65 if (!isdigit(*cp))
66 goto inv;
67 digits[i] = *cp++ - '0';
68 }
69 if (*cp)
70 goto inv;
71 for (i = 0; i < 8; i++)
72 bytes[i] = pcm_order ? digits[i*2+1] << 4 | digits[i*2]
73 : digits[i*2] << 4 | digits[i*2+1];
74 printf("Writing \"%02X %02X %02X %02X %02X %02X %02X %02X\" into %s\n",
75 bytes[0], bytes[1], bytes[2], bytes[3], bytes[4], bytes[5],
76 bytes[6], bytes[7], filename);
77 send_file_write(filename, bytes, 8);
78 }
79
80 void
81 cmd_set_pcm_string(argc, argv)
82 char **argv;
83 {
84 char filename[16];
85
86 if (strcmp(argv[1], "CGMI") && strcmp(argv[1], "CGMM") &&
87 strcmp(argv[1], "CGMR") && strcmp(argv[1], "CGSN")) {
88 printf("error: \"%s\" is not a recognized PCM string file name\n",
89 argv[1]);
90 return;
91 }
92 sprintf(filename, "/pcm/%s", argv[1]);
93 if (strlen(argv[2]) > 20) {
94 printf("error: %s string may not exceed 20 characters\n",
95 filename);
96 return;
97 }
98 send_file_write(filename, argv[2], strlen(argv[2]));
99 }
100
101 void
102 cmd_set_rfcap(argc, argv)
103 char **argv;
104 {
105 u_char bytes[16];
106 int i;
107
108 for (i = 0; i < 16; i++)
109 bytes[i] = strtoul(argv[i+1], 0, 16);
110 send_file_write("/gsm/com/rfcap", bytes, 16);
111 }