jajn HA
/
C027_SupportTest
final
Fork of C027_SupportTest by
main.cpp@34:2d06e42fac2c, 2017-07-20 (annotated)
- Committer:
- david8251
- Date:
- Thu Jul 20 09:02:49 2017 +0000
- Revision:
- 34:2d06e42fac2c
- Parent:
- 33:e27f40fada64
final
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
lawliet | 0:4e3cb26f6019 | 1 | #include "mbed.h" |
david8251 | 34:2d06e42fac2c | 2 | #include "MMA7455.h" |
david8251 | 34:2d06e42fac2c | 3 | #include "MDM.h" |
mazgch | 9:26f694bc31b4 | 4 | |
david8251 | 34:2d06e42fac2c | 5 | #define PI 3.1415926535897932384626433832795028841971693993751058209749445923078164062862089986280348253 |
david8251 | 34:2d06e42fac2c | 6 | |
mazgch | 30:062717f25e41 | 7 | #define SIMPIN "1922" |
david8251 | 34:2d06e42fac2c | 8 | |
mazgch | 21:a090a5043e23 | 9 | #define APN NULL |
mazgch | 19:f022ff746eb8 | 10 | //! Set the user name for your APN, or NULL if not needed |
mazgch | 19:f022ff746eb8 | 11 | #define USERNAME NULL |
mazgch | 19:f022ff746eb8 | 12 | //! Set the password for your APN, or NULL if not needed |
mazgch | 19:f022ff746eb8 | 13 | #define PASSWORD NULL |
david8251 | 34:2d06e42fac2c | 14 | |
david8251 | 34:2d06e42fac2c | 15 | MMA7455 acc(p32,p31); |
david8251 | 34:2d06e42fac2c | 16 | |
david8251 | 34:2d06e42fac2c | 17 | void task_MMA(); |
lawliet | 0:4e3cb26f6019 | 18 | |
msinig | 29:16f1037626e3 | 19 | |
david8251 | 34:2d06e42fac2c | 20 | double a,b,c; |
david8251 | 34:2d06e42fac2c | 21 | char str[90]; |
david8251 | 34:2d06e42fac2c | 22 | char str1[90]; |
david8251 | 34:2d06e42fac2c | 23 | char str2[90]; |
lawliet | 0:4e3cb26f6019 | 24 | int main(void) |
lawliet | 0:4e3cb26f6019 | 25 | { |
david8251 | 34:2d06e42fac2c | 26 | acc.setMode(MMA7455::ModeMeasurement); |
david8251 | 34:2d06e42fac2c | 27 | acc.setRange(MMA7455::Range_2g); |
david8251 | 34:2d06e42fac2c | 28 | acc.calibrate(); |
david8251 | 34:2d06e42fac2c | 29 | |
mazgch | 2:b77151f111a9 | 30 | int ret; |
mazgch | 19:f022ff746eb8 | 31 | #ifdef LARGE_DATA |
mazgch | 16:43f6de7bc38b | 32 | char buf[2048] = ""; |
mazgch | 17:c293780a40ac | 33 | #else |
mazgch | 17:c293780a40ac | 34 | char buf[512] = ""; |
mazgch | 17:c293780a40ac | 35 | #endif |
david8251 | 34:2d06e42fac2c | 36 | |
david8251 | 34:2d06e42fac2c | 37 | MDMSerial mdm; |
mazgch | 19:f022ff746eb8 | 38 | MDMParser::DevStatus devStatus = {}; |
mazgch | 19:f022ff746eb8 | 39 | MDMParser::NetStatus netStatus = {}; |
mazgch | 10:d2da2028a233 | 40 | bool mdmOk = mdm.init(SIMPIN, &devStatus); |
mazgch | 19:f022ff746eb8 | 41 | mdm.dumpDevStatus(&devStatus); |
david8251 | 34:2d06e42fac2c | 42 | |
david8251 | 34:2d06e42fac2c | 43 | |
david8251 | 34:2d06e42fac2c | 44 | |
david8251 | 34:2d06e42fac2c | 45 | task_MMA(); |
david8251 | 34:2d06e42fac2c | 46 | |
david8251 | 34:2d06e42fac2c | 47 | |
david8251 | 34:2d06e42fac2c | 48 | |
mazgch | 19:f022ff746eb8 | 49 | if (mdmOk) { |
mazgch | 20:52f0e5de8c3d | 50 | #if 0 |
mazgch | 20:52f0e5de8c3d | 51 | // file system API |
mazgch | 19:f022ff746eb8 | 52 | const char* filename = "File"; |
mazgch | 19:f022ff746eb8 | 53 | char buf[] = "Hello World"; |
mazgch | 19:f022ff746eb8 | 54 | printf("writeFile \"%s\"\r\n", buf); |
mazgch | 19:f022ff746eb8 | 55 | if (mdm.writeFile(filename, buf, sizeof(buf))) |
mazgch | 19:f022ff746eb8 | 56 | { |
mazgch | 19:f022ff746eb8 | 57 | memset(buf, 0, sizeof(buf)); |
mazgch | 19:f022ff746eb8 | 58 | int len = mdm.readFile(filename, buf, sizeof(buf)); |
mazgch | 24:81f5b43a6585 | 59 | if (len >= 0) |
mazgch | 19:f022ff746eb8 | 60 | printf("readFile %d \"%.*s\"\r\n", len, len, buf); |
mazgch | 19:f022ff746eb8 | 61 | mdm.delFile(filename); |
mazgch | 19:f022ff746eb8 | 62 | } |
mazgch | 20:52f0e5de8c3d | 63 | #endif |
mazgch | 20:52f0e5de8c3d | 64 | mdmOk = mdm.registerNet(&netStatus); |
mazgch | 20:52f0e5de8c3d | 65 | mdm.dumpNetStatus(&netStatus); |
mazgch | 20:52f0e5de8c3d | 66 | } |
mazgch | 20:52f0e5de8c3d | 67 | if (mdmOk) |
mazgch | 20:52f0e5de8c3d | 68 | { |
mazgch | 4:90ab1ec64b0e | 69 | // join the internet connection |
mazgch | 19:f022ff746eb8 | 70 | MDMParser::IP ip = mdm.join(APN,USERNAME,PASSWORD); |
mazgch | 32:b838fcaba45e | 71 | if (ip == NOIP) |
mazgch | 32:b838fcaba45e | 72 | printf("Not able to join network"); |
mazgch | 32:b838fcaba45e | 73 | else |
mazgch | 2:b77151f111a9 | 74 | { |
mazgch | 19:f022ff746eb8 | 75 | mdm.dumpIp(ip); |
mazgch | 19:f022ff746eb8 | 76 | printf("Make a Http Post Request\r\n"); |
mazgch | 4:90ab1ec64b0e | 77 | int socket = mdm.socketSocket(MDMParser::IPPROTO_TCP); |
mazgch | 4:90ab1ec64b0e | 78 | if (socket >= 0) |
mazgch | 2:b77151f111a9 | 79 | { |
mazgch | 16:43f6de7bc38b | 80 | mdm.socketSetBlocking(socket, 10000); |
david8251 | 34:2d06e42fac2c | 81 | if (mdm.socketConnect(socket, "140.118.206.213", 555)) |
mazgch | 4:90ab1ec64b0e | 82 | { |
david8251 | 34:2d06e42fac2c | 83 | mdm.socketSend(socket, str, sizeof(str)-1); |
mazgch | 4:90ab1ec64b0e | 84 | |
mazgch | 19:f022ff746eb8 | 85 | ret = mdm.socketRecv(socket, buf, sizeof(buf)-1); |
mazgch | 19:f022ff746eb8 | 86 | if (ret > 0) |
mazgch | 19:f022ff746eb8 | 87 | printf("Socket Recv \"%*s\"\r\n", ret, buf); |
mazgch | 4:90ab1ec64b0e | 88 | mdm.socketClose(socket); |
mazgch | 4:90ab1ec64b0e | 89 | } |
mazgch | 4:90ab1ec64b0e | 90 | mdm.socketFree(socket); |
mazgch | 4:90ab1ec64b0e | 91 | } |
mazgch | 2:b77151f111a9 | 92 | |
mazgch | 16:43f6de7bc38b | 93 | int port = 7; |
mazgch | 16:43f6de7bc38b | 94 | const char* host = "echo.u-blox.com"; |
mazgch | 16:43f6de7bc38b | 95 | MDMParser::IP ip = mdm.gethostbyname(host); |
mazgch | 16:43f6de7bc38b | 96 | char data[] = "\r\nxxx Socket Hello World\r\n" |
mazgch | 19:f022ff746eb8 | 97 | #ifdef LARGE_DATA |
mazgch | 17:c293780a40ac | 98 | "00 0123456789 0123456789 0123456789 0123456789 0123456789 \r\n" |
mazgch | 17:c293780a40ac | 99 | "01 0123456789 0123456789 0123456789 0123456789 0123456789 \r\n" |
mazgch | 17:c293780a40ac | 100 | "02 0123456789 0123456789 0123456789 0123456789 0123456789 \r\n" |
mazgch | 17:c293780a40ac | 101 | "03 0123456789 0123456789 0123456789 0123456789 0123456789 \r\n" |
mazgch | 17:c293780a40ac | 102 | "04 0123456789 0123456789 0123456789 0123456789 0123456789 \r\n" |
mazgch | 17:c293780a40ac | 103 | |
mazgch | 17:c293780a40ac | 104 | "05 0123456789 0123456789 0123456789 0123456789 0123456789 \r\n" |
mazgch | 17:c293780a40ac | 105 | "06 0123456789 0123456789 0123456789 0123456789 0123456789 \r\n" |
mazgch | 17:c293780a40ac | 106 | "07 0123456789 0123456789 0123456789 0123456789 0123456789 \r\n" |
mazgch | 17:c293780a40ac | 107 | "08 0123456789 0123456789 0123456789 0123456789 0123456789 \r\n" |
mazgch | 17:c293780a40ac | 108 | "09 0123456789 0123456789 0123456789 0123456789 0123456789 \r\n" |
mazgch | 16:43f6de7bc38b | 109 | |
mazgch | 17:c293780a40ac | 110 | "10 0123456789 0123456789 0123456789 0123456789 0123456789 \r\n" |
mazgch | 17:c293780a40ac | 111 | "11 0123456789 0123456789 0123456789 0123456789 0123456789 \r\n" |
mazgch | 17:c293780a40ac | 112 | "12 0123456789 0123456789 0123456789 0123456789 0123456789 \r\n" |
mazgch | 17:c293780a40ac | 113 | "13 0123456789 0123456789 0123456789 0123456789 0123456789 \r\n" |
mazgch | 17:c293780a40ac | 114 | "14 0123456789 0123456789 0123456789 0123456789 0123456789 \r\n" |
mazgch | 17:c293780a40ac | 115 | |
mazgch | 17:c293780a40ac | 116 | "15 0123456789 0123456789 0123456789 0123456789 0123456789 \r\n" |
mazgch | 17:c293780a40ac | 117 | "16 0123456789 0123456789 0123456789 0123456789 0123456789 \r\n" |
mazgch | 17:c293780a40ac | 118 | "17 0123456789 0123456789 0123456789 0123456789 0123456789 \r\n" |
mazgch | 17:c293780a40ac | 119 | "18 0123456789 0123456789 0123456789 0123456789 0123456789 \r\n" |
mazgch | 17:c293780a40ac | 120 | "19 0123456789 0123456789 0123456789 0123456789 0123456789 \r\n" |
mazgch | 16:43f6de7bc38b | 121 | #endif |
mazgch | 17:c293780a40ac | 122 | "End\r\n"; |
mazgch | 16:43f6de7bc38b | 123 | |
mazgch | 19:f022ff746eb8 | 124 | printf("Testing TCP sockets with ECHO server\r\n"); |
mazgch | 16:43f6de7bc38b | 125 | socket = mdm.socketSocket(MDMParser::IPPROTO_TCP); |
mazgch | 16:43f6de7bc38b | 126 | if (socket >= 0) |
mazgch | 16:43f6de7bc38b | 127 | { |
mazgch | 16:43f6de7bc38b | 128 | mdm.socketSetBlocking(socket, 10000); |
mazgch | 16:43f6de7bc38b | 129 | if (mdm.socketConnect(socket, host, port)) { |
mazgch | 16:43f6de7bc38b | 130 | memcpy(data, "\r\nTCP", 5); |
mazgch | 16:43f6de7bc38b | 131 | ret = mdm.socketSend(socket, data, sizeof(data)-1); |
mazgch | 16:43f6de7bc38b | 132 | if (ret == sizeof(data)-1) { |
mazgch | 19:f022ff746eb8 | 133 | printf("Socket Send %d \"%s\"\r\n", ret, data); |
mazgch | 16:43f6de7bc38b | 134 | } |
mazgch | 16:43f6de7bc38b | 135 | ret = mdm.socketRecv(socket, buf, sizeof(buf)-1); |
mazgch | 16:43f6de7bc38b | 136 | if (ret >= 0) { |
mazgch | 19:f022ff746eb8 | 137 | printf("Socket Recv %d \"%.*s\"\r\n", ret, ret, buf); |
mazgch | 16:43f6de7bc38b | 138 | } |
mazgch | 16:43f6de7bc38b | 139 | mdm.socketClose(socket); |
mazgch | 16:43f6de7bc38b | 140 | } |
mazgch | 16:43f6de7bc38b | 141 | mdm.socketFree(socket); |
mazgch | 16:43f6de7bc38b | 142 | } |
mazgch | 16:43f6de7bc38b | 143 | |
mazgch | 19:f022ff746eb8 | 144 | printf("Testing UDP sockets with ECHO server\r\n"); |
mazgch | 16:43f6de7bc38b | 145 | socket = mdm.socketSocket(MDMParser::IPPROTO_UDP, port); |
mazgch | 16:43f6de7bc38b | 146 | if (socket >= 0) |
mazgch | 16:43f6de7bc38b | 147 | { |
mazgch | 16:43f6de7bc38b | 148 | mdm.socketSetBlocking(socket, 10000); |
mazgch | 16:43f6de7bc38b | 149 | memcpy(data, "\r\nUDP", 5); |
mazgch | 16:43f6de7bc38b | 150 | ret = mdm.socketSendTo(socket, ip, port, data, sizeof(data)-1); |
mazgch | 16:43f6de7bc38b | 151 | if (ret == sizeof(data)-1) { |
mazgch | 19:f022ff746eb8 | 152 | printf("Socket SendTo %s:%d " IPSTR " %d \"%s\"\r\n", host, port, IPNUM(ip), ret, data); |
mazgch | 16:43f6de7bc38b | 153 | } |
mazgch | 16:43f6de7bc38b | 154 | ret = mdm.socketRecvFrom(socket, &ip, &port, buf, sizeof(buf)-1); |
mazgch | 16:43f6de7bc38b | 155 | if (ret >= 0) { |
mazgch | 19:f022ff746eb8 | 156 | printf("Socket RecvFrom " IPSTR ":%d %d \"%.*s\" \r\n", IPNUM(ip),port, ret, ret,buf); |
mazgch | 16:43f6de7bc38b | 157 | } |
mazgch | 16:43f6de7bc38b | 158 | mdm.socketFree(socket); |
mazgch | 16:43f6de7bc38b | 159 | } |
mazgch | 16:43f6de7bc38b | 160 | |
mazgch | 4:90ab1ec64b0e | 161 | // disconnect |
mazgch | 4:90ab1ec64b0e | 162 | mdm.disconnect(); |
mazgch | 2:b77151f111a9 | 163 | } |
mazgch | 30:062717f25e41 | 164 | |
mazgch | 30:062717f25e41 | 165 | const char* ussd = "*130#"; // You may get answer "UNKNOWN APPLICATION" |
mazgch | 30:062717f25e41 | 166 | printf("Ussd Send Command %s\r\n", ussd); |
mazgch | 30:062717f25e41 | 167 | ret = mdm.ussdCommand(ussd, buf); |
mazgch | 30:062717f25e41 | 168 | if (ret > 0) |
mazgch | 30:062717f25e41 | 169 | printf("Ussd Got Answer: \"%s\"\r\n", buf); |
mazgch | 10:d2da2028a233 | 170 | } |
msinig | 29:16f1037626e3 | 171 | #ifdef CELLOCATE |
msinig | 29:16f1037626e3 | 172 | const int sensorMask = 3; // Hybrid: GNSS + CellLocate |
msinig | 29:16f1037626e3 | 173 | const int timeoutMargin = 5; // seconds |
msinig | 29:16f1037626e3 | 174 | const int submitPeriod = 60; // 1 minutes in seconds |
msinig | 29:16f1037626e3 | 175 | const int targetAccuracy = 1; // meters |
msinig | 29:16f1037626e3 | 176 | unsigned int j = submitPeriod * 1000/wait; |
msinig | 29:16f1037626e3 | 177 | bool cellLocWait = false; |
msinig | 29:16f1037626e3 | 178 | MDMParser::CellLocData loc; |
msinig | 29:16f1037626e3 | 179 | |
msinig | 29:16f1037626e3 | 180 | if (!mdm.cellLocSrvHttp("TOKEN")) |
msinig | 29:16f1037626e3 | 181 | mdm.cellLocSrvUdp(); |
msinig | 29:16f1037626e3 | 182 | mdm.cellLocConfigSensor(1); // Deep scan mode |
david8251 | 34:2d06e42fac2c | 183 | |
msinig | 29:16f1037626e3 | 184 | #endif |
mazgch | 10:d2da2028a233 | 185 | mdm.powerOff(); |
lawliet | 0:4e3cb26f6019 | 186 | return 0; |
lawliet | 0:4e3cb26f6019 | 187 | } |
david8251 | 34:2d06e42fac2c | 188 | void task_MMA(){ |
david8251 | 34:2d06e42fac2c | 189 | |
david8251 | 34:2d06e42fac2c | 190 | |
david8251 | 34:2d06e42fac2c | 191 | char filename[64]; |
david8251 | 34:2d06e42fac2c | 192 | int32_t x,y,z; |
david8251 | 34:2d06e42fac2c | 193 | double x1,y1,z1; |
david8251 | 34:2d06e42fac2c | 194 | double xg,yg,zg; |
david8251 | 34:2d06e42fac2c | 195 | double xd,yd,zd; |
david8251 | 34:2d06e42fac2c | 196 | acc.read(x,y,z); |
david8251 | 34:2d06e42fac2c | 197 | |
david8251 | 34:2d06e42fac2c | 198 | xg=x*0.016; //實際g值 |
david8251 | 34:2d06e42fac2c | 199 | yg=y*0.016; //實際g值 |
david8251 | 34:2d06e42fac2c | 200 | zg=z*0.016; //實際g值 |
david8251 | 34:2d06e42fac2c | 201 | |
david8251 | 34:2d06e42fac2c | 202 | x1=xg/(sqrt(pow(yg,2.0)+pow(zg,2.0))); |
david8251 | 34:2d06e42fac2c | 203 | y1=yg/(sqrt(pow(xg,2.0)+pow(zg,2.0))); |
david8251 | 34:2d06e42fac2c | 204 | z1=(sqrt(pow(yg,2.0)+pow(xg,2.0)))/zg; |
david8251 | 34:2d06e42fac2c | 205 | |
david8251 | 34:2d06e42fac2c | 206 | xd=atan(x1); //徑度 |
david8251 | 34:2d06e42fac2c | 207 | yd=atan(y1); //徑度 |
david8251 | 34:2d06e42fac2c | 208 | zd=atan(z1); //徑度 |
david8251 | 34:2d06e42fac2c | 209 | |
david8251 | 34:2d06e42fac2c | 210 | a=xd*180.0/PI; |
david8251 | 34:2d06e42fac2c | 211 | b=yd*180.0/PI; |
david8251 | 34:2d06e42fac2c | 212 | c=zd*180.0/PI; |
david8251 | 34:2d06e42fac2c | 213 | |
david8251 | 34:2d06e42fac2c | 214 | sprintf(str,"%.2f\t",a); |
david8251 | 34:2d06e42fac2c | 215 | sprintf(str1,"%.2f\t",b); |
david8251 | 34:2d06e42fac2c | 216 | sprintf(str2,"%.2f",c); |
david8251 | 34:2d06e42fac2c | 217 | |
david8251 | 34:2d06e42fac2c | 218 | strcat(str,str1); |
david8251 | 34:2d06e42fac2c | 219 | strcat(str,str2); |
david8251 | 34:2d06e42fac2c | 220 | |
david8251 | 34:2d06e42fac2c | 221 | puts(str); |
david8251 | 34:2d06e42fac2c | 222 | |
david8251 | 34:2d06e42fac2c | 223 | |
david8251 | 34:2d06e42fac2c | 224 | printf("xd: %.2f ",xd*180.0/PI); |
david8251 | 34:2d06e42fac2c | 225 | printf("yd: %.2f ",yd*180.0/PI); |
david8251 | 34:2d06e42fac2c | 226 | printf("zd: %.2f ",zd*180.0/PI); |
david8251 | 34:2d06e42fac2c | 227 | printf("\r\n\n"); |
david8251 | 34:2d06e42fac2c | 228 | } |