Dependencies:   ChaNFSSD mbed BMP085 SHT2x

Committer:
tosihisa
Date:
Sun Feb 05 13:35:15 2012 +0000
Revision:
5:3a1ce282892c
Parent:
4:879b8dcfee15
Child:
6:4af28d398585
V0.83

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