Toshihisa T / Mbed 2 deprecated ENVLogger

Dependencies:   ChaNFSSD mbed BMP085 SHT2x

main.cpp@6:4af28d398585, 2012-02-09 (annotated)

Committer:
tosihisa
Date:
Thu Feb 09 17:05:36 2012 +0000
Revision:
6:4af28d398585
Parent:
5:3a1ce282892c
Child:
7:74ce774e53ef
V0.84

Who changed what in which revision?

UserRevisionLine numberNew contents of line
tosihisa 1:83960ee4d9a2 1 /*
tosihisa 1:83960ee4d9a2 2 * このソフトウェアは、大阪市立大学と京都大学生存圏ミッション研究の共同研究の成果物です。
tosihisa 1:83960ee4d9a2 3 * ソースコードそのもののライセンスは、各ソースコードのライセンスに沿って公開します。
tosihisa 1:83960ee4d9a2 4 * 2012-1-4 Toshihisa T
tosihisa 1:83960ee4d9a2 5 */
tosihisa 3:844fbe607dae 6
tosihisa 6:4af28d398585 7 #define __MY_VERSION__ "0.84"
tosihisa 4:879b8dcfee15 8
tosihisa 3:844fbe607dae 9 #define HAVE_TOGGLE_SW
tosihisa 3:844fbe607dae 10 #define HAVE_MICROSD
tosihisa 3:844fbe607dae 11
tosihisa 0:6089ae824f06 12 #include "mbed.h"
tosihisa 0:6089ae824f06 13 #include "NMEA_parse.h"
tosihisa 0:6089ae824f06 14 #include "SDFileSystem.h"
tosihisa 0:6089ae824f06 15 #include "libT/mbed/tserialbuffer.h"
tosihisa 0:6089ae824f06 16 #include "BMP085.h"
tosihisa 0:6089ae824f06 17 #include "SHT2x.h"
tosihisa 0:6089ae824f06 18 #include "AD7994.h"
tosihisa 0:6089ae824f06 19 //#include "TextLCD.h"
tosihisa 0:6089ae824f06 20 #include "TextLCD_20X4.h"
tosihisa 1:83960ee4d9a2 21 #include "UBXPacket.h"
tosihisa 0:6089ae824f06 22
tosihisa 0:6089ae824f06 23 using namespace libT;
tosihisa 0:6089ae824f06 24
tosihisa 0:6089ae824f06 25 #define _USE_FS_NAME "sd"
tosihisa 0:6089ae824f06 26
tosihisa 0:6089ae824f06 27 Serial debug(USBTX,USBRX);
tosihisa 0:6089ae824f06 28
tosihisa 0:6089ae824f06 29 DigitalIn gps_int0(p24);
tosihisa 0:6089ae824f06 30 DigitalOut gps_reset(p25);
tosihisa 0:6089ae824f06 31 InterruptIn gps_pps(p26);
tosihisa 0:6089ae824f06 32 tSerialBuffer gps(p28,p27);
tosihisa 0:6089ae824f06 33 DigitalOut gps_pps_led(LED2);
tosihisa 1:83960ee4d9a2 34 I2C i2c(p9, p10); // sda, scl
tosihisa 0:6089ae824f06 35 BMP085 bmp085(p9, p10);
tosihisa 4:879b8dcfee15 36 int bmp085_find = 0;
tosihisa 2:f546aaa0e1d5 37 SHT2x sht25(p9,p10);
tosihisa 4:879b8dcfee15 38 int sht25_find = 0;
tosihisa 0:6089ae824f06 39 AD7994 ad7994(p9,p10);
tosihisa 4:879b8dcfee15 40 int ad7994_find = 0;
tosihisa 0:6089ae824f06 41 TextLCD_20X4 lcd(p15, p16, p17, p18, p19, p20); // rs, e, d4-d7
tosihisa 3:844fbe607dae 42 #ifdef HAVE_TOGGLE_SW /* { */
tosihisa 3:844fbe607dae 43 DigitalIn toggleSW(p22);
tosihisa 3:844fbe607dae 44 int toggleSW_scan = 0;
tosihisa 3:844fbe607dae 45 int toggleSW_pre = -1;
tosihisa 3:844fbe607dae 46 #endif /* } */
tosihisa 3:844fbe607dae 47 int toggleSW_now = 0;
tosihisa 3:844fbe607dae 48 Ticker tick;
tosihisa 4:879b8dcfee15 49 tSerialBuffer CO2(p13,p14);
tosihisa 4:879b8dcfee15 50 Timer CO2_TMOUT;
tosihisa 0:6089ae824f06 51
tosihisa 1:83960ee4d9a2 52 SDFileSystem sd(p5, p6, p7, p8, _USE_FS_NAME);
tosihisa 3:844fbe607dae 53 int avaiableSD = -1;
tosihisa 3:844fbe607dae 54 unsigned short logNextCount = 0;
tosihisa 3:844fbe607dae 55 FILE *csvFP = NULL;
tosihisa 3:844fbe607dae 56 FILE *gpsFP = NULL;
tosihisa 3:844fbe607dae 57 int logSW = 0;
tosihisa 6:4af28d398585 58 LocalFileSystem local("local");
tosihisa 4:879b8dcfee15 59
tosihisa 3:844fbe607dae 60 DigitalOut logled(LED3);
tosihisa 0:6089ae824f06 61 DigitalOut myled(LED1);
tosihisa 0:6089ae824f06 62
tosihisa 1:83960ee4d9a2 63 struct UBXPacket_s UBXPacket;
tosihisa 1:83960ee4d9a2 64
tosihisa 0:6089ae824f06 65 int pps_count = 0;
tosihisa 0:6089ae824f06 66 void gps_pps_rise()
tosihisa 0:6089ae824f06 67 {
tosihisa 0:6089ae824f06 68 gps_pps_led = ((pps_count+=1) & 1) ? 1 : 0;
tosihisa 0:6089ae824f06 69 }
tosihisa 0:6089ae824f06 70
tosihisa 3:844fbe607dae 71 void logFile_Init() {
tosihisa 0:6089ae824f06 72 DIR *d;
tosihisa 0:6089ae824f06 73 struct dirent *p;
tosihisa 3:844fbe607dae 74 unsigned short countCandidate;
tosihisa 3:844fbe607dae 75 char *endptr;
tosihisa 0:6089ae824f06 76
tosihisa 6:4af28d398585 77 //この return を有効にすると、SDカードのチェックを行いません。
tosihisa 6:4af28d398585 78 //return;
tosihisa 6:4af28d398585 79
tosihisa 3:844fbe607dae 80 avaiableSD = 0;
tosihisa 0:6089ae824f06 81 d = opendir("/" _USE_FS_NAME);
tosihisa 0:6089ae824f06 82 if ( d != NULL ) {
tosihisa 0:6089ae824f06 83 while ( (p = readdir(d)) != NULL ) {
tosihisa 0:6089ae824f06 84 debug.printf("FILE - %s\x0d\x0a", p->d_name);
tosihisa 3:844fbe607dae 85 if (strlen(p->d_name) == (sizeof("ENVxxxxx.CSV")-1)) {
tosihisa 3:844fbe607dae 86 if ( ((p->d_name[0] == 'E') || (p->d_name[0] == 'e'))
tosihisa 3:844fbe607dae 87 && ((p->d_name[1] == 'N') || (p->d_name[1] == 'n'))
tosihisa 3:844fbe607dae 88 && ((p->d_name[2] == 'V') || (p->d_name[2] == 'v'))) {
tosihisa 3:844fbe607dae 89 }
tosihisa 3:844fbe607dae 90 countCandidate = (unsigned short)strtoul(&(p->d_name[3]),&endptr,10);
tosihisa 3:844fbe607dae 91 if (strcasecmp(endptr,".CSV") == 0) {
tosihisa 3:844fbe607dae 92 if (countCandidate > logNextCount) {
tosihisa 3:844fbe607dae 93 logNextCount = countCandidate;
tosihisa 3:844fbe607dae 94 }
tosihisa 3:844fbe607dae 95 }
tosihisa 3:844fbe607dae 96 }
tosihisa 0:6089ae824f06 97 }
tosihisa 0:6089ae824f06 98 closedir(d);
tosihisa 3:844fbe607dae 99 logNextCount++;
tosihisa 3:844fbe607dae 100 avaiableSD = 1;
tosihisa 0:6089ae824f06 101 }
tosihisa 0:6089ae824f06 102 }
tosihisa 0:6089ae824f06 103
tosihisa 0:6089ae824f06 104
tosihisa 0:6089ae824f06 105 int CO2_Read(unsigned short *val)
tosihisa 0:6089ae824f06 106 {
tosihisa 0:6089ae824f06 107 unsigned char sbuf[] = { 0xFE, 0x04, 0x00, 0x03, 0x00, 0x01, 0xD5, 0xC5 };
tosihisa 0:6089ae824f06 108 unsigned char rbuf[7];
tosihisa 0:6089ae824f06 109 int i;
tosihisa 0:6089ae824f06 110 unsigned short crc;
tosihisa 0:6089ae824f06 111 extern unsigned short modbus_CRC(unsigned char *DataPtr, unsigned short len);
tosihisa 0:6089ae824f06 112
tosihisa 0:6089ae824f06 113 for(i=0;i < sizeof(sbuf);i++){
tosihisa 0:6089ae824f06 114 //debug.printf("0x%02x ",sbuf[i]);
tosihisa 0:6089ae824f06 115 CO2.putc(sbuf[i]);
tosihisa 0:6089ae824f06 116 }
tosihisa 4:879b8dcfee15 117 CO2_TMOUT.start();
tosihisa 0:6089ae824f06 118 for(i=0;i < sizeof(rbuf);i++){
tosihisa 4:879b8dcfee15 119 while(!CO2.readable()){
tosihisa 4:879b8dcfee15 120 if(CO2_TMOUT.read_ms() >= 1000){
tosihisa 4:879b8dcfee15 121 return -99; /* TIMEOUT */
tosihisa 4:879b8dcfee15 122 }
tosihisa 4:879b8dcfee15 123 }
tosihisa 0:6089ae824f06 124 rbuf[i] = CO2.getc();
tosihisa 0:6089ae824f06 125 }
tosihisa 1:83960ee4d9a2 126 if(rbuf[0] != 0xFE){
tosihisa 1:83960ee4d9a2 127 return -4;
tosihisa 1:83960ee4d9a2 128 }
tosihisa 1:83960ee4d9a2 129 if(rbuf[1] != 0x04){
tosihisa 1:83960ee4d9a2 130 return -1;
tosihisa 1:83960ee4d9a2 131 }
tosihisa 1:83960ee4d9a2 132 if(rbuf[2] != 0x02){
tosihisa 1:83960ee4d9a2 133 return -2;
tosihisa 1:83960ee4d9a2 134 }
tosihisa 0:6089ae824f06 135 crc = rbuf[6];
tosihisa 0:6089ae824f06 136 crc = (crc << 8) | rbuf[5];
tosihisa 0:6089ae824f06 137 if(crc != modbus_CRC(rbuf,5)){
tosihisa 1:83960ee4d9a2 138 return -3;
tosihisa 0:6089ae824f06 139 }
tosihisa 0:6089ae824f06 140 *val = rbuf[3];
tosihisa 0:6089ae824f06 141 *val = (*val << 8) | rbuf[4];
tosihisa 0:6089ae824f06 142 return 0;
tosihisa 0:6089ae824f06 143 }
tosihisa 0:6089ae824f06 144
tosihisa 0:6089ae824f06 145 // BMP085 0xee
tosihisa 4:879b8dcfee15 146 // AD7994 0x44
tosihisa 4:879b8dcfee15 147 // SHT2x 0x80
tosihisa 0:6089ae824f06 148 int i2c_found() {
tosihisa 0:6089ae824f06 149 int count = 0;
tosihisa 5:3a1ce282892c 150 lcd.locate(0,0);
tosihisa 1:83960ee4d9a2 151 lcd.printf("%-19s","I2C Dev:");
tosihisa 5:3a1ce282892c 152 lcd.locate(8,0);
tosihisa 0:6089ae824f06 153 for (int address=0; address<256; address+=2) {
tosihisa 0:6089ae824f06 154 if (!i2c.write(address, NULL, 0)) { // 0 returned is ok
tosihisa 4:879b8dcfee15 155 switch(address){
tosihisa 4:879b8dcfee15 156 case 0xee: bmp085_find = 1; break;
tosihisa 4:879b8dcfee15 157 case 0x44: ad7994_find = 1; break;
tosihisa 4:879b8dcfee15 158 case 0x80: sht25_find = 1; break;
tosihisa 4:879b8dcfee15 159 default: break;
tosihisa 4:879b8dcfee15 160 }
tosihisa 1:83960ee4d9a2 161 lcd.printf("%02X ",address);
tosihisa 0:6089ae824f06 162 count++;
tosihisa 0:6089ae824f06 163 }
tosihisa 0:6089ae824f06 164 }
tosihisa 0:6089ae824f06 165 return count;
tosihisa 0:6089ae824f06 166 }
tosihisa 1:83960ee4d9a2 167
tosihisa 1:83960ee4d9a2 168 unsigned char NMEA_CalcSum(unsigned char *str,int len)
tosihisa 1:83960ee4d9a2 169 {
tosihisa 1:83960ee4d9a2 170 unsigned char sum = 0;
tosihisa 1:83960ee4d9a2 171 int i;
tosihisa 1:83960ee4d9a2 172 for(i = 0;i < len;i++){
tosihisa 1:83960ee4d9a2 173 sum = sum ^ (*(str + i));
tosihisa 1:83960ee4d9a2 174 }
tosihisa 1:83960ee4d9a2 175 return sum;
tosihisa 1:83960ee4d9a2 176 }
tosihisa 1:83960ee4d9a2 177
tosihisa 1:83960ee4d9a2 178 void UBX_CalcSum(unsigned char *str,int len,unsigned char *sum)
tosihisa 1:83960ee4d9a2 179 {
tosihisa 1:83960ee4d9a2 180 int i;
tosihisa 1:83960ee4d9a2 181 *(sum + 0) = *(sum + 1) = 0;
tosihisa 1:83960ee4d9a2 182 for(i = 0;i < len;i++){
tosihisa 1:83960ee4d9a2 183 *(sum + 0) = *(sum + 0) + *(str+i);
tosihisa 1:83960ee4d9a2 184 *(sum + 1) = *(sum + 1) + *(sum + 0);
tosihisa 1:83960ee4d9a2 185 }
tosihisa 1:83960ee4d9a2 186 }
tosihisa 1:83960ee4d9a2 187
tosihisa 1:83960ee4d9a2 188 int UBX_WaitAck(struct UBXPacket_s *info)
tosihisa 1:83960ee4d9a2 189 {
tosihisa 1:83960ee4d9a2 190 UBXPacket.cjobst = 0;
tosihisa 1:83960ee4d9a2 191
tosihisa 1:83960ee4d9a2 192 while(1){
tosihisa 1:83960ee4d9a2 193 while(gps.readable()) {
tosihisa 1:83960ee4d9a2 194 if(UBXPacket_Parse(&UBXPacket,gps.getc()) == 100){
tosihisa 1:83960ee4d9a2 195 if((UBXPacket.cls == 0x05) && (UBXPacket.id == 0x01)){
tosihisa 1:83960ee4d9a2 196 return 1; /* ACK */
tosihisa 1:83960ee4d9a2 197 } else if((UBXPacket.cls == 0x05) && (UBXPacket.id == 0x00)){
tosihisa 1:83960ee4d9a2 198 return 0; /* NAK */
tosihisa 1:83960ee4d9a2 199 } else {
tosihisa 1:83960ee4d9a2 200 UBXPacket.cjobst = 0;
tosihisa 1:83960ee4d9a2 201 }
tosihisa 1:83960ee4d9a2 202 }
tosihisa 1:83960ee4d9a2 203 }
tosihisa 1:83960ee4d9a2 204 }
tosihisa 3:844fbe607dae 205 }
tosihisa 3:844fbe607dae 206
tosihisa 4:879b8dcfee15 207 unsigned long scanCount = 0;
tosihisa 3:844fbe607dae 208 unsigned long tickCount = 0;
tosihisa 3:844fbe607dae 209 unsigned long hzCount = 0;
tosihisa 3:844fbe607dae 210 unsigned long hzCount_tmp = 0;
tosihisa 3:844fbe607dae 211 void tickHandler()
tosihisa 3:844fbe607dae 212 {
tosihisa 4:879b8dcfee15 213 scanCount++;
tosihisa 3:844fbe607dae 214 tickCount++;
tosihisa 3:844fbe607dae 215 hzCount_tmp++;
tosihisa 3:844fbe607dae 216 if(hzCount_tmp >= 50){
tosihisa 3:844fbe607dae 217 hzCount_tmp = 0;
tosihisa 3:844fbe607dae 218 hzCount++;
tosihisa 3:844fbe607dae 219 }
tosihisa 3:844fbe607dae 220 #ifdef HAVE_TOGGLE_SW /* { */
tosihisa 3:844fbe607dae 221 int nowRead;
tosihisa 3:844fbe607dae 222 nowRead = toggleSW.read();
tosihisa 3:844fbe607dae 223 if(nowRead != toggleSW_pre){
tosihisa 3:844fbe607dae 224 toggleSW_pre = nowRead;
tosihisa 3:844fbe607dae 225 toggleSW_scan = 0;
tosihisa 3:844fbe607dae 226 } else {
tosihisa 3:844fbe607dae 227 toggleSW_scan++;
tosihisa 3:844fbe607dae 228 if(toggleSW_scan >= 3){
tosihisa 3:844fbe607dae 229 toggleSW_now = toggleSW_pre;
tosihisa 3:844fbe607dae 230 toggleSW_scan = 0;
tosihisa 3:844fbe607dae 231 }
tosihisa 3:844fbe607dae 232 }
tosihisa 3:844fbe607dae 233 #endif
tosihisa 3:844fbe607dae 234 }
tosihisa 3:844fbe607dae 235
tosihisa 3:844fbe607dae 236 void logCheckProc()
tosihisa 3:844fbe607dae 237 {
tosihisa 3:844fbe607dae 238 if((logSW == 0) && (toggleSW_now != 0)){
tosihisa 3:844fbe607dae 239 if(csvFP != NULL){
tosihisa 3:844fbe607dae 240 fclose(csvFP);
tosihisa 3:844fbe607dae 241 csvFP = NULL;
tosihisa 3:844fbe607dae 242 if(gpsFP != NULL){
tosihisa 3:844fbe607dae 243 fclose(gpsFP);
tosihisa 3:844fbe607dae 244 gpsFP = NULL;
tosihisa 3:844fbe607dae 245 }
tosihisa 3:844fbe607dae 246 logled = 0; /* No logging */
tosihisa 3:844fbe607dae 247 logNextCount++;
tosihisa 3:844fbe607dae 248 } else {
tosihisa 3:844fbe607dae 249 char name[64];
tosihisa 3:844fbe607dae 250 sprintf(name,"/%s/ENV%05d.CSV",_USE_FS_NAME,logNextCount);
tosihisa 3:844fbe607dae 251 csvFP = fopen(name,"w+b");
tosihisa 6:4af28d398585 252 sprintf(name,"/%s/ENV%05d.UBX",_USE_FS_NAME,logNextCount);
tosihisa 3:844fbe607dae 253 gpsFP = fopen(name,"w+b");
tosihisa 3:844fbe607dae 254 if((csvFP != NULL) && (gpsFP != NULL)){
tosihisa 3:844fbe607dae 255 logled = 1; /* logging */
tosihisa 3:844fbe607dae 256 } else {
tosihisa 3:844fbe607dae 257 if(csvFP) fclose(csvFP);
tosihisa 3:844fbe607dae 258 if(gpsFP) fclose(gpsFP);
tosihisa 3:844fbe607dae 259 logled = 0; /* Cannot start logging */
tosihisa 3:844fbe607dae 260 }
tosihisa 3:844fbe607dae 261 }
tosihisa 3:844fbe607dae 262 }
tosihisa 3:844fbe607dae 263 logSW = toggleSW_now;
tosihisa 1:83960ee4d9a2 264 }
tosihisa 1:83960ee4d9a2 265
tosihisa 1:83960ee4d9a2 266 unsigned char wbuf[1024];
tosihisa 2:f546aaa0e1d5 267 int widx = 0;
tosihisa 0:6089ae824f06 268
tosihisa 4:879b8dcfee15 269 void ClearScreen(void)
tosihisa 4:879b8dcfee15 270 {
tosihisa 4:879b8dcfee15 271 lcd.locate(0,0); lcd.printf("%20s"," ");
tosihisa 4:879b8dcfee15 272 lcd.locate(0,1); lcd.printf("%20s"," ");
tosihisa 4:879b8dcfee15 273 lcd.locate(0,2); lcd.printf("%20s"," ");
tosihisa 4:879b8dcfee15 274 lcd.locate(0,3); lcd.printf("%20s"," ");
tosihisa 4:879b8dcfee15 275 }
tosihisa 4:879b8dcfee15 276
tosihisa 0:6089ae824f06 277 int main() {
tosihisa 0:6089ae824f06 278 int ret = 0;
tosihisa 3:844fbe607dae 279 float p, t1;
tosihisa 3:844fbe607dae 280 float h, t2;
tosihisa 0:6089ae824f06 281 int temp;
tosihisa 4:879b8dcfee15 282 unsigned short CO2_val = 0;
tosihisa 1:83960ee4d9a2 283 char c;
tosihisa 2:f546aaa0e1d5 284 unsigned long UBXCount = 0;
tosihisa 4:879b8dcfee15 285 int GPS_isRaw = 0;
tosihisa 4:879b8dcfee15 286 int CO2_find = 0;
tosihisa 4:879b8dcfee15 287 int year=0;
tosihisa 4:879b8dcfee15 288 int mon=0;
tosihisa 4:879b8dcfee15 289 int day=0;
tosihisa 4:879b8dcfee15 290 int hour=0;
tosihisa 4:879b8dcfee15 291 int min=0;
tosihisa 4:879b8dcfee15 292 int sec=0;
tosihisa 4:879b8dcfee15 293 int pre_sec = -1;
tosihisa 0:6089ae824f06 294
tosihisa 4:879b8dcfee15 295 p = -99.0;
tosihisa 4:879b8dcfee15 296 t1 = -99.0;
tosihisa 4:879b8dcfee15 297 t2 = -99.0;
tosihisa 4:879b8dcfee15 298 h = -99.0;
tosihisa 4:879b8dcfee15 299
tosihisa 3:844fbe607dae 300 tick.attach_us(&tickHandler,(10*1000));
tosihisa 3:844fbe607dae 301
tosihisa 0:6089ae824f06 302 debug.format(8,Serial::None,1);
tosihisa 0:6089ae824f06 303 debug.baud(115200);
tosihisa 4:879b8dcfee15 304 debug.printf("ENV Logger \"%s\" Start (BUILD:[" __DATE__ "/" __TIME__ "])\n",__MY_VERSION__);
tosihisa 0:6089ae824f06 305
tosihisa 0:6089ae824f06 306 lcd.locate(0,0);
tosihisa 4:879b8dcfee15 307 lcd.printf("ENV Logger \"%s\"",__MY_VERSION__);
tosihisa 2:f546aaa0e1d5 308
tosihisa 2:f546aaa0e1d5 309 lcd.locate(0,1);
tosihisa 2:f546aaa0e1d5 310 lcd.printf("WAKE UP I/O...");
tosihisa 1:83960ee4d9a2 311 wait(5.0);
tosihisa 0:6089ae824f06 312
tosihisa 4:879b8dcfee15 313 ClearScreen();
tosihisa 4:879b8dcfee15 314
tosihisa 5:3a1ce282892c 315 //===================================================
tosihisa 5:3a1ce282892c 316 i2c_found();
tosihisa 5:3a1ce282892c 317
tosihisa 5:3a1ce282892c 318 //===================================================
tosihisa 5:3a1ce282892c 319 CO2.format(8,Serial::None,1);
tosihisa 5:3a1ce282892c 320 CO2.baud(9600);
tosihisa 5:3a1ce282892c 321 CO2.recvStart();
tosihisa 5:3a1ce282892c 322
tosihisa 5:3a1ce282892c 323 lcd.locate(0,1);
tosihisa 5:3a1ce282892c 324 lcd.printf("Check CO2:");
tosihisa 5:3a1ce282892c 325 CO2_find = 0;
tosihisa 5:3a1ce282892c 326 ret = CO2_Read(&CO2_val);
tosihisa 5:3a1ce282892c 327 switch(ret){
tosihisa 3:844fbe607dae 328 case 0:
tosihisa 5:3a1ce282892c 329 lcd.printf("OK");
tosihisa 5:3a1ce282892c 330 CO2_find = 1;
tosihisa 3:844fbe607dae 331 break;
tosihisa 5:3a1ce282892c 332 case -99:
tosihisa 5:3a1ce282892c 333 lcd.printf("NOT FOUND");
tosihisa 3:844fbe607dae 334 break;
tosihisa 3:844fbe607dae 335 default:
tosihisa 5:3a1ce282892c 336 lcd.printf("NG");
tosihisa 3:844fbe607dae 337 break;
tosihisa 3:844fbe607dae 338 }
tosihisa 5:3a1ce282892c 339 CO2_val = 0;
tosihisa 5:3a1ce282892c 340
tosihisa 5:3a1ce282892c 341 //===================================================
tosihisa 5:3a1ce282892c 342 lcd.locate(0,2);
tosihisa 4:879b8dcfee15 343 lcd.printf("Initalize GPS:");
tosihisa 2:f546aaa0e1d5 344
tosihisa 1:83960ee4d9a2 345 UBXPacket.cjobst = 0;
tosihisa 1:83960ee4d9a2 346
tosihisa 0:6089ae824f06 347 gps_pps.rise(gps_pps_rise);
tosihisa 0:6089ae824f06 348 gps.format(8,Serial::None,1);
tosihisa 0:6089ae824f06 349 gps.baud(9600);
tosihisa 0:6089ae824f06 350
tosihisa 0:6089ae824f06 351 gps_reset = 1;
tosihisa 0:6089ae824f06 352 wait(0.5);
tosihisa 0:6089ae824f06 353 gps_reset = 0;
tosihisa 0:6089ae824f06 354
tosihisa 1:83960ee4d9a2 355 wait(0.5);
tosihisa 1:83960ee4d9a2 356 if(1){
tosihisa 1:83960ee4d9a2 357 //unsigned char modeStr[] = "PUBX,41,1,0007,0003,115200,0";
tosihisa 1:83960ee4d9a2 358 unsigned char modeStr[] = "PUBX,41,1,0007,0001,115200,0";
tosihisa 1:83960ee4d9a2 359 unsigned char sum = NMEA_CalcSum(modeStr,strlen((char *)modeStr));
tosihisa 1:83960ee4d9a2 360 debug.printf("SEND:[%s](0x%02X)\n",modeStr,sum);
tosihisa 1:83960ee4d9a2 361 gps.printf("$%s*%02X%c%c",modeStr,sum,0x0d,0x0a);
tosihisa 1:83960ee4d9a2 362
tosihisa 1:83960ee4d9a2 363 debug.printf("CHG BAUD:115200\n");
tosihisa 1:83960ee4d9a2 364 gps.format(8,Serial::None,1);
tosihisa 1:83960ee4d9a2 365 gps.baud(115200);
tosihisa 1:83960ee4d9a2 366 }
tosihisa 1:83960ee4d9a2 367
tosihisa 1:83960ee4d9a2 368 gps.recvStart();
tosihisa 1:83960ee4d9a2 369 wait(0.5);
tosihisa 0:6089ae824f06 370
tosihisa 4:879b8dcfee15 371 GPS_isRaw = 1;
tosihisa 1:83960ee4d9a2 372 if(1){
tosihisa 1:83960ee4d9a2 373 unsigned char chkStr[][11] = {
tosihisa 4:879b8dcfee15 374 { 0xB5,0x62,0x06,0x01,0x03,0x00,0x02,0x10,0x01,0xFF,0xFF }, //RXM-RAW (0x02 0x10)
tosihisa 4:879b8dcfee15 375 { 0xB5,0x62,0x06,0x01,0x03,0x00,0x02,0x30,0x01,0xFF,0xFF }, //RXM-ALM (0x02 0x30)
tosihisa 4:879b8dcfee15 376 { 0xB5,0x62,0x06,0x01,0x03,0x00,0x02,0x31,0x01,0xFF,0xFF }, //RXM-EPH (0x02 0x31)
tosihisa 1:83960ee4d9a2 377 //{ 0xB5,0x62,0x06,0x01,0x03,0x00,0x02,0x41,0x02,0xFF,0xFF },
tosihisa 4:879b8dcfee15 378 { 0xB5,0x62,0x06,0x01,0x03,0x00,0x02,0x11,0x01,0xFF,0xFF }, //RXM-SFRB (0x02 0x11)
tosihisa 4:879b8dcfee15 379 { 0xB5,0x62,0x06,0x01,0x03,0x00,0x02,0x20,0x01,0xFF,0xFF }, //RXM-SVSI (0x02 0x20)
tosihisa 4:879b8dcfee15 380 { 0xB5,0x62,0x06,0x01,0x03,0x00,0x01,0x21,0x01,0xFF,0xFF }, //NAV-TIMEUTC (0x01 0x21)
tosihisa 1:83960ee4d9a2 381 { 0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0xFF,0xFF }, //END
tosihisa 1:83960ee4d9a2 382 };
tosihisa 1:83960ee4d9a2 383 int i,j;
tosihisa 4:879b8dcfee15 384 int isAck;
tosihisa 1:83960ee4d9a2 385
tosihisa 1:83960ee4d9a2 386 for(j=0;chkStr[j][0] != 0x00;j++){
tosihisa 1:83960ee4d9a2 387 UBX_CalcSum(&chkStr[j][2],7,&chkStr[j][9]);
tosihisa 1:83960ee4d9a2 388 for(i = 0; i < sizeof(chkStr[0]);i++){
tosihisa 1:83960ee4d9a2 389 gps.putc(chkStr[j][i]);
tosihisa 1:83960ee4d9a2 390 }
tosihisa 4:879b8dcfee15 391 isAck = UBX_WaitAck(&UBXPacket);
tosihisa 4:879b8dcfee15 392 debug.printf("%d : SET UBX Rate : %s\n",j,(isAck == 1) ? "ACK" : "NAK");
tosihisa 4:879b8dcfee15 393 if(isAck != 1){
tosihisa 4:879b8dcfee15 394 GPS_isRaw = 0;
tosihisa 4:879b8dcfee15 395 }
tosihisa 1:83960ee4d9a2 396 }
tosihisa 1:83960ee4d9a2 397 }
tosihisa 1:83960ee4d9a2 398 UBXPacket.cjobst = 0;
tosihisa 5:3a1ce282892c 399 lcd.locate(0,2);
tosihisa 4:879b8dcfee15 400 lcd.printf("Initalize GPS:%s",(GPS_isRaw) ? "OK" : "NG");
tosihisa 4:879b8dcfee15 401
tosihisa 1:83960ee4d9a2 402 // ad7994.Start();
tosihisa 1:83960ee4d9a2 403
tosihisa 5:3a1ce282892c 404 //===================================================
tosihisa 5:3a1ce282892c 405 #ifdef HAVE_MICROSD
tosihisa 5:3a1ce282892c 406 lcd.locate(0,3);
tosihisa 5:3a1ce282892c 407 lcd.printf("Check MicroSD:");
tosihisa 5:3a1ce282892c 408 logFile_Init();
tosihisa 5:3a1ce282892c 409 #endif
tosihisa 4:879b8dcfee15 410 lcd.locate(0,3);
tosihisa 5:3a1ce282892c 411 switch(avaiableSD){
tosihisa 4:879b8dcfee15 412 case 0:
tosihisa 5:3a1ce282892c 413 lcd.printf("Check MicroSD:NG");
tosihisa 4:879b8dcfee15 414 break;
tosihisa 5:3a1ce282892c 415 case 1:
tosihisa 5:3a1ce282892c 416 lcd.printf("Check MicroSD:OK");
tosihisa 4:879b8dcfee15 417 break;
tosihisa 4:879b8dcfee15 418 default:
tosihisa 6:4af28d398585 419 lcd.printf("Check MicroSD:SKIP");
tosihisa 4:879b8dcfee15 420 break;
tosihisa 4:879b8dcfee15 421 }
tosihisa 5:3a1ce282892c 422
tosihisa 5:3a1ce282892c 423 //===================================================
tosihisa 3:844fbe607dae 424
tosihisa 4:879b8dcfee15 425 wait(3.0);
tosihisa 4:879b8dcfee15 426
tosihisa 4:879b8dcfee15 427 ClearScreen();
tosihisa 4:879b8dcfee15 428
tosihisa 4:879b8dcfee15 429 pre_sec = -1;
tosihisa 0:6089ae824f06 430 while(1) {
tosihisa 0:6089ae824f06 431 //lcd.cls();
tosihisa 2:f546aaa0e1d5 432 //lcd.locate(0,0);
tosihisa 2:f546aaa0e1d5 433 //lcd.printf("SCAN:%-10ld",scanCount);
tosihisa 3:844fbe607dae 434
tosihisa 3:844fbe607dae 435 logCheckProc();
tosihisa 0:6089ae824f06 436
tosihisa 0:6089ae824f06 437 while(gps.readable()) {
tosihisa 1:83960ee4d9a2 438 c = gps.getc();
tosihisa 1:83960ee4d9a2 439 if(UBXPacket_Parse(&UBXPacket,c) == 100){
tosihisa 2:f546aaa0e1d5 440 UBXCount++;
tosihisa 4:879b8dcfee15 441 if((UBXPacket.cls == 0x01) && (UBXPacket.id == 0x21)){
tosihisa 4:879b8dcfee15 442 /* NAV-TIMEUTC */
tosihisa 4:879b8dcfee15 443 year = (((unsigned short)UBXPacket.body[13]) << 8) | UBXPacket.body[12];
tosihisa 4:879b8dcfee15 444 mon = UBXPacket.body[14];
tosihisa 4:879b8dcfee15 445 day = UBXPacket.body[15];
tosihisa 4:879b8dcfee15 446 hour = UBXPacket.body[16];
tosihisa 4:879b8dcfee15 447 min = UBXPacket.body[17];
tosihisa 4:879b8dcfee15 448 sec = UBXPacket.body[18];
tosihisa 4:879b8dcfee15 449 }
tosihisa 1:83960ee4d9a2 450 debug.printf("%ld : GET UBX Packet (Class=0x%02X,ID=0x%02X,LEN=%d)\n",
tosihisa 1:83960ee4d9a2 451 scanCount,
tosihisa 1:83960ee4d9a2 452 UBXPacket.cls,
tosihisa 1:83960ee4d9a2 453 UBXPacket.id,
tosihisa 1:83960ee4d9a2 454 UBXPacket.len );
tosihisa 1:83960ee4d9a2 455 UBXPacket.cjobst = 0;
tosihisa 1:83960ee4d9a2 456 }
tosihisa 3:844fbe607dae 457 if(gpsFP != NULL){
tosihisa 3:844fbe607dae 458 wbuf[widx] = c;
tosihisa 3:844fbe607dae 459 widx++;
tosihisa 3:844fbe607dae 460 if(widx >= sizeof(wbuf)){
tosihisa 3:844fbe607dae 461 fwrite(&wbuf,sizeof(wbuf[0]),widx,gpsFP);
tosihisa 3:844fbe607dae 462 widx = 0;
tosihisa 3:844fbe607dae 463 }
tosihisa 3:844fbe607dae 464 }
tosihisa 0:6089ae824f06 465 }
tosihisa 4:879b8dcfee15 466 lcd.locate(0,0);
tosihisa 5:3a1ce282892c 467 lcd.printf("%c%04d-%02d-%02d %02d:%02d:%02d",(gpsFP) ? '*' : ' ',year,mon,day,hour,min,sec);
tosihisa 0:6089ae824f06 468
tosihisa 4:879b8dcfee15 469 if(pre_sec != sec){
tosihisa 4:879b8dcfee15 470 pre_sec = sec;
tosihisa 4:879b8dcfee15 471
tosihisa 4:879b8dcfee15 472 if(bmp085_find){
tosihisa 4:879b8dcfee15 473 float tmp1,tmp2;
tosihisa 4:879b8dcfee15 474 bmp085.update();
tosihisa 4:879b8dcfee15 475 tmp1 = bmp085.get_pressure();
tosihisa 4:879b8dcfee15 476 tmp2 = bmp085.get_temperature();
tosihisa 4:879b8dcfee15 477 if(tmp2 < 100.0){
tosihisa 4:879b8dcfee15 478 p = tmp1;
tosihisa 4:879b8dcfee15 479 t1 = tmp2;
tosihisa 4:879b8dcfee15 480 }
tosihisa 4:879b8dcfee15 481 }
tosihisa 4:879b8dcfee15 482 lcd.locate(0,1); lcd.printf("%-8.2fhPa %-6.2fC", p, t1);
tosihisa 0:6089ae824f06 483
tosihisa 4:879b8dcfee15 484 if(sht25_find){
tosihisa 5:3a1ce282892c 485 if(sht25.SHT2x_MeasurePoll(TEMP,&temp) == 0){
tosihisa 5:3a1ce282892c 486 t2 = sht25.SHT2x_CalcTemperatureC(temp);
tosihisa 5:3a1ce282892c 487 }
tosihisa 5:3a1ce282892c 488 if(sht25.SHT2x_MeasurePoll(HUMIDITY,&temp) == 0){
tosihisa 5:3a1ce282892c 489 h = sht25.SHT2x_CalcRH(temp);
tosihisa 5:3a1ce282892c 490 }
tosihisa 5:3a1ce282892c 491 sht25.SHT2x_SoftReset();
tosihisa 4:879b8dcfee15 492 }
tosihisa 4:879b8dcfee15 493 lcd.locate(0,2); lcd.printf("%-6.2fC %-6.2fRH", t2, h);
tosihisa 1:83960ee4d9a2 494
tosihisa 4:879b8dcfee15 495 if(CO2_find){
tosihisa 4:879b8dcfee15 496 if((ret = CO2_Read(&CO2_val)) != 0){
tosihisa 4:879b8dcfee15 497 CO2_val = 0;
tosihisa 4:879b8dcfee15 498 CO2_find = 0;
tosihisa 4:879b8dcfee15 499 }
tosihisa 4:879b8dcfee15 500 }
tosihisa 4:879b8dcfee15 501 lcd.locate(0,3); lcd.printf("CO2:%5d.%1dppm\n",CO2_val/10,CO2_val%10);
tosihisa 0:6089ae824f06 502
tosihisa 4:879b8dcfee15 503 if(csvFP){
tosihisa 4:879b8dcfee15 504 fprintf(csvFP,"%04d-%02d-%02d %02d:%02d:%02d,",year,mon,day,hour,min,sec);
tosihisa 3:844fbe607dae 505 fprintf(csvFP,"%-8.2f,hPa,%-6.2f,C,%-6.2f,C,%-6.2f,RH,%5d.%1d,ppm\x0d\x0a", p, t1, t2, h,CO2_val/10,CO2_val%10);
tosihisa 3:844fbe607dae 506 }
tosihisa 3:844fbe607dae 507 }
tosihisa 1:83960ee4d9a2 508 #if 0
tosihisa 0:6089ae824f06 509 ad7994.update();
tosihisa 0:6089ae824f06 510 lcd.locate(0,3);
tosihisa 0:6089ae824f06 511 lcd.printf("A/D:%04X/%04X",
tosihisa 0:6089ae824f06 512 ad7994.readChn(0),
tosihisa 0:6089ae824f06 513 ad7994.readChn(1));
tosihisa 1:83960ee4d9a2 514 #endif
tosihisa 3:844fbe607dae 515 myled = (hzCount & 1);
tosihisa 4:879b8dcfee15 516 //wait(0.1);
tosihisa 0:6089ae824f06 517 }
tosihisa 0:6089ae824f06 518 }
tosihisa 2:f546aaa0e1d5 519
tosihisa 2:f546aaa0e1d5 520 /*
tosihisa 6:4af28d398585 521 * 2012-2-10 V0.84
tosihisa 6:4af28d398585 522 *
tosihisa 6:4af28d398585 523 * *GPSデータの保存拡張子を .GPS から .UBX に変更。
tosihisa 6:4af28d398585 524 * UBXバイナリである事を示す。rtklib で処理できることを確認。
tosihisa 6:4af28d398585 525 * *mbedライブラリ、FATFileSystemライブラリを最新に更新。
tosihisa 6:4af28d398585 526 */
tosihisa 6:4af28d398585 527 /*
tosihisa 5:3a1ce282892c 528 * 2012-2-5 V0.83
tosihisa 5:3a1ce282892c 529 * センサー、I/Oの検出順番を変更(H/W 組立時の試験を兼ねる)
tosihisa 5:3a1ce282892c 530 * 下記の順番でセンサーやI/Oの検出をする。
tosihisa 5:3a1ce282892c 531 * I2C → CO2センサー → U-Blox(raw-mode) → マイクロSD
tosihisa 5:3a1ce282892c 532 * マイクロSD が未装着でも U-Blox の raw-mode までは
tosihisa 5:3a1ce282892c 533 * 進めるので、H/W 組立後の基本チェックが可能。
tosihisa 5:3a1ce282892c 534 */
tosihisa 5:3a1ce282892c 535 /*
tosihisa 5:3a1ce282892c 536 * 2012-2-5 V0.82
tosihisa 5:3a1ce282892c 537 * バイクによる実走試験での結果を反映。
tosihisa 5:3a1ce282892c 538 * 1) ログボタンのON/OFFでLEDも光らせるが、ケースに収めると
tosihisa 5:3a1ce282892c 539 * LED だと分からなくなるので、液晶画面でもログのON/OFFが
tosihisa 5:3a1ce282892c 540 * 分かるようにした。ログをONすると、画面左上に'*'を出す。
tosihisa 5:3a1ce282892c 541 * 2) SHT25 が、時々オフセットがかかったかの様な値を返すので、
tosihisa 5:3a1ce282892c 542 * 下記の修正を行った。但しこの修正が確実かはまだ分からない。
tosihisa 5:3a1ce282892c 543 * a) 関数の戻り値が正常な場合に値を採用する。これは必要。
tosihisa 5:3a1ce282892c 544 * b) 温湿度の取得後、SHT25 に対してソフトリセット命令を
tosihisa 6:4af28d398585 545 * 毎回送る。これでうまく行くようならこれでいく。
tosihisa 6:4af28d398585 546 * →2012-2-10 今のところ問題は見つからない。これで進める。
tosihisa 5:3a1ce282892c 547 */
tosihisa 5:3a1ce282892c 548 /*
tosihisa 4:879b8dcfee15 549 * 2012-2-5 V0.81
tosihisa 4:879b8dcfee15 550 * 気圧センサーが時々不正な値を出力する。気温が100度を超える値になる。
tosihisa 4:879b8dcfee15 551 * ソフトバグか、センサー自身の問題かは切り分けていないが、気温が100度を
tosihisa 4:879b8dcfee15 552 * 超えることはあり得ないので、100度を超える気温は値として採用しない様に
tosihisa 4:879b8dcfee15 553 * した。
tosihisa 4:879b8dcfee15 554 */
tosihisa 4:879b8dcfee15 555 /*
tosihisa 4:879b8dcfee15 556 * 2012-2-5 V0.8
tosihisa 4:879b8dcfee15 557 * 1) GPS レシーバ受信バッファが少ないので拡大(512->8K)
tosihisa 4:879b8dcfee15 558 * 2) 起動時に、各センサーの接続チェックを行い、起動時に見つかった
tosihisa 4:879b8dcfee15 559 * センサーとだけ通信するようにした。これにより CO2 センサーが
tosihisa 4:879b8dcfee15 560 * 無くても動きます。
tosihisa 4:879b8dcfee15 561 * 3) NAV-TIMEUTC を受信し、表示するようにした。
tosihisa 4:879b8dcfee15 562 * 4) センサーデータのスキャンタイミングを、NAV-TIMEUTC の
tosihisa 4:879b8dcfee15 563 * 秒が変わった直後とした。つまり1秒おきにセンサーデータを
tosihisa 4:879b8dcfee15 564 * スキャンする。
tosihisa 4:879b8dcfee15 565 * 5) センサーデータの保存データ(ENVnnnnn.CSV) の先頭に
tosihisa 4:879b8dcfee15 566 * NAV-TIMEUTC の日付時刻を入れるようにした。
tosihisa 4:879b8dcfee15 567 * これで何時何分のセンサーデータか分かるようにした。
tosihisa 4:879b8dcfee15 568 */
tosihisa 4:879b8dcfee15 569 /*
tosihisa 3:844fbe607dae 570 * 2012-1-29 V0.7
tosihisa 3:844fbe607dae 571 * ログ機能の追加。スイッチを押すとログのON/OFFが出来る。
tosihisa 3:844fbe607dae 572 * ログ収集中は、mbed LED3 が点灯する。
tosihisa 3:844fbe607dae 573 */
tosihisa 3:844fbe607dae 574 /*
tosihisa 3:844fbe607dae 575 * 2012-1-29 V0.6
tosihisa 3:844fbe607dae 576 * 1) スキャンカウントの変更。今までは1秒周期だったが、
tosihisa 3:844fbe607dae 577 * 100ミリ秒周期でセンサーデータを得るようにした。
tosihisa 3:844fbe607dae 578 * 2) モーメンタリSW対応。
tosihisa 3:844fbe607dae 579 */
tosihisa 3:844fbe607dae 580 /*
tosihisa 2:f546aaa0e1d5 581 * 2012-1-23 V0.5
tosihisa 2:f546aaa0e1d5 582 * U-Blox,気圧センサー,温度センサー,CO2センサーの値を表示するようにした。
tosihisa 2:f546aaa0e1d5 583 * U-Blox は受信できたパケット数を表示する。
tosihisa 2:f546aaa0e1d5 584 * マイクロSDへの保存機能はまだ(H/W的に動くのは確認済み)
tosihisa 2:f546aaa0e1d5 585 */