LE YOU / Mbed 2 deprecated mas

tiz

Dependencies:   TextLCD X_NUCLEO_IKS01A1 func mbed-src mbed

Fork of mas by esproj

main.cpp@6:fb1b3ce7738d, 2016-09-14 (annotated)

Committer:
youle1119
Date:
Wed Sep 14 10:49:56 2016 +0000
Revision:
6:fb1b3ce7738d
Parent:
5:100310ea8fba 
tiz

Who changed what in which revision?

UserRevisionLine numberNew contents of line
herenvarno 0:99767aa66bce 1 /**
herenvarno 0:99767aa66bce 2 ******************************************************************************
herenvarno 0:99767aa66bce 3 * @file main.cpp
herenvarno 0:99767aa66bce 4 * @author AST / EST
herenvarno 0:99767aa66bce 5 * @version V0.0.1
herenvarno 0:99767aa66bce 6 * @date 14-August-2015
herenvarno 0:99767aa66bce 7 * @brief Simple Example application for using the X_NUCLEO_IKS01A1
herenvarno 0:99767aa66bce 8 * MEMS Inertial & Environmental Sensor Nucleo expansion board.
herenvarno 0:99767aa66bce 9 ******************************************************************************
herenvarno 0:99767aa66bce 10 * @attention
herenvarno 0:99767aa66bce 11 *
herenvarno 0:99767aa66bce 12 * <h2><center>&copy; COPYRIGHT(c) 2015 STMicroelectronics</center></h2>
herenvarno 0:99767aa66bce 13 *
herenvarno 0:99767aa66bce 14 * Redistribution and use in source and binary forms, with or without modification,
herenvarno 0:99767aa66bce 15 * are permitted provided that the following conditions are met:
herenvarno 0:99767aa66bce 16 * 1. Redistributions of source code must retain the above copyright notice,
herenvarno 0:99767aa66bce 17 * this list of conditions and the following disclaimer.
herenvarno 0:99767aa66bce 18 * 2. Redistributions in binary form must reproduce the above copyright notice,
herenvarno 0:99767aa66bce 19 * this list of conditions and the following disclaimer in the documentation
herenvarno 0:99767aa66bce 20 * and/or other materials provided with the distribution.
herenvarno 0:99767aa66bce 21 * 3. Neither the name of STMicroelectronics nor the names of its contributors
herenvarno 0:99767aa66bce 22 * may be used to endorse or promote products derived from this software
herenvarno 0:99767aa66bce 23 * without specific prior written permission.
herenvarno 0:99767aa66bce 24 *
herenvarno 0:99767aa66bce 25 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
herenvarno 0:99767aa66bce 26 * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
herenvarno 0:99767aa66bce 27 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
herenvarno 0:99767aa66bce 28 * DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE
herenvarno 0:99767aa66bce 29 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
herenvarno 0:99767aa66bce 30 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
herenvarno 0:99767aa66bce 31 * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
herenvarno 0:99767aa66bce 32 * CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
herenvarno 0:99767aa66bce 33 * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
herenvarno 0:99767aa66bce 34 * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
herenvarno 0:99767aa66bce 35 *
herenvarno 0:99767aa66bce 36 ******************************************************************************
herenvarno 0:99767aa66bce 37 */
herenvarno 0:99767aa66bce 38
herenvarno 0:99767aa66bce 39 /* Includes */
herenvarno 3:4355890e55b4 40 #include "main.h"
herenvarno 0:99767aa66bce 41
herenvarno 0:99767aa66bce 42 /* Instantiate the expansion board */
herenvarno 0:99767aa66bce 43 static X_NUCLEO_IKS01A1 *mems_expansion_board = X_NUCLEO_IKS01A1::Instance(D14, D15);
herenvarno 0:99767aa66bce 44
herenvarno 0:99767aa66bce 45 /* Retrieve the composing elements of the expansion board */
herenvarno 0:99767aa66bce 46 static GyroSensor *gyroscope = mems_expansion_board->GetGyroscope();
herenvarno 0:99767aa66bce 47 static MotionSensor *accelerometer = mems_expansion_board->GetAccelerometer();
herenvarno 0:99767aa66bce 48 static MagneticSensor *magnetometer = mems_expansion_board->magnetometer;
herenvarno 0:99767aa66bce 49 static HumiditySensor *humidity_sensor = mems_expansion_board->ht_sensor;
herenvarno 0:99767aa66bce 50 static PressureSensor *pressure_sensor = mems_expansion_board->pt_sensor;
herenvarno 0:99767aa66bce 51 static TempSensor *temp_sensor1 = mems_expansion_board->ht_sensor;
herenvarno 0:99767aa66bce 52 static TempSensor *temp_sensor2 = mems_expansion_board->pt_sensor;
herenvarno 0:99767aa66bce 53
herenvarno 0:99767aa66bce 54 /* Helper function for printing floats & doubles */
herenvarno 0:99767aa66bce 55 static char *printDouble(char* str, double v, int decimalDigits=2)
herenvarno 0:99767aa66bce 56 {
herenvarno 0:99767aa66bce 57 int i = 1;
herenvarno 0:99767aa66bce 58 int intPart, fractPart;
herenvarno 0:99767aa66bce 59 int len;
herenvarno 0:99767aa66bce 60 char *ptr;
herenvarno 0:99767aa66bce 61
herenvarno 0:99767aa66bce 62 /* prepare decimal digits multiplicator */
herenvarno 0:99767aa66bce 63 for (;decimalDigits!=0; i*=10, decimalDigits--);
herenvarno 0:99767aa66bce 64
herenvarno 0:99767aa66bce 65 /* calculate integer & fractinal parts */
herenvarno 0:99767aa66bce 66 intPart = (int)v;
herenvarno 0:99767aa66bce 67 fractPart = (int)((v-(double)(int)v)*i);
herenvarno 0:99767aa66bce 68
herenvarno 0:99767aa66bce 69 /* fill in integer part */
herenvarno 0:99767aa66bce 70 sprintf(str, "%i.", intPart);
herenvarno 0:99767aa66bce 71
herenvarno 0:99767aa66bce 72 /* prepare fill in of fractional part */
herenvarno 0:99767aa66bce 73 len = strlen(str);
herenvarno 0:99767aa66bce 74 ptr = &str[len];
herenvarno 0:99767aa66bce 75
herenvarno 0:99767aa66bce 76 /* fill in leading fractional zeros */
herenvarno 0:99767aa66bce 77 for (i/=10;i>1; i/=10, ptr++) {
herenvarno 0:99767aa66bce 78 if(fractPart >= i) break;
herenvarno 0:99767aa66bce 79 *ptr = '0';
herenvarno 0:99767aa66bce 80 }
herenvarno 0:99767aa66bce 81
herenvarno 0:99767aa66bce 82 /* fill in (rest of) fractional part */
herenvarno 0:99767aa66bce 83 sprintf(ptr, "%i", fractPart);
herenvarno 0:99767aa66bce 84
herenvarno 0:99767aa66bce 85 return str;
herenvarno 0:99767aa66bce 86 }
herenvarno 0:99767aa66bce 87
herenvarno 0:99767aa66bce 88 DigitalOut myled(LED1);
herenvarno 0:99767aa66bce 89 DigitalIn mybutton(USER_BUTTON);
herenvarno 3:4355890e55b4 90 Display mydisplay;
herenvarno 3:4355890e55b4 91 RawData myrawdata;
herenvarno 0:99767aa66bce 92
herenvarno 3:4355890e55b4 93 uint8_t fbtn=BTN_RELEASED;
herenvarno 3:4355890e55b4 94 uint8_t fbtn_counter=0;
herenvarno 3:4355890e55b4 95 uint8_t mode=MODE_NORMAL;
herenvarno 3:4355890e55b4 96 uint8_t func=FUNC_DATETIME;
herenvarno 3:4355890e55b4 97 uint8_t config_index=0;
herenvarno 4:3fecfc9eeadd 98 uint8_t flag_flash=0;
herenvarno 3:4355890e55b4 99
herenvarno 3:4355890e55b4 100
herenvarno 3:4355890e55b4 101 /**
herenvarno 3:4355890e55b4 102 * FUNC: wait_action
herenvarno 3:4355890e55b4 103 * DESC: wait for pressing button action, update the global flag for next polling cycle
herenvarno 3:4355890e55b4 104 */
herenvarno 3:4355890e55b4 105 void wait_action()
herenvarno 3:4355890e55b4 106 {
herenvarno 3:4355890e55b4 107 fbtn=BTN_RELEASED;
herenvarno 3:4355890e55b4 108 for(int i=0; i<5; i++)
herenvarno 3:4355890e55b4 109 {
herenvarno 3:4355890e55b4 110 if(fbtn==BTN_RELEASED)
herenvarno 3:4355890e55b4 111 {
herenvarno 3:4355890e55b4 112 if(mybutton==1 and fbtn==BTN_RELEASED)
herenvarno 3:4355890e55b4 113 {
herenvarno 5:100310ea8fba 114 if(fbtn_counter>0 and fbtn_counter<=20)
herenvarno 3:4355890e55b4 115 {
herenvarno 3:4355890e55b4 116 fbtn=BTN_PRESSED;
herenvarno 3:4355890e55b4 117 }
herenvarno 5:100310ea8fba 118 else if(fbtn_counter>20 and fbtn_counter<=50)
herenvarno 3:4355890e55b4 119 {
herenvarno 3:4355890e55b4 120 fbtn=BTN_PRESSED_LONG;
herenvarno 3:4355890e55b4 121 }
herenvarno 5:100310ea8fba 122 else if(fbtn_counter>50)
herenvarno 3:4355890e55b4 123 {
herenvarno 3:4355890e55b4 124 fbtn=BTN_PRESSED_VERY_LONG;
herenvarno 3:4355890e55b4 125 }
herenvarno 3:4355890e55b4 126 fbtn_counter=0;
herenvarno 3:4355890e55b4 127 }
herenvarno 3:4355890e55b4 128 else
herenvarno 3:4355890e55b4 129 {
herenvarno 3:4355890e55b4 130 fbtn_counter+=1;
herenvarno 3:4355890e55b4 131 }
herenvarno 3:4355890e55b4 132 }
herenvarno 3:4355890e55b4 133 wait(0.1);
herenvarno 3:4355890e55b4 134 }
herenvarno 3:4355890e55b4 135 }
herenvarno 3:4355890e55b4 136
herenvarno 1:1df80fe13928 137
herenvarno 0:99767aa66bce 138 /* Simple main function */
herenvarno 0:99767aa66bce 139 int main() {
herenvarno 0:99767aa66bce 140 myled=0;
herenvarno 0:99767aa66bce 141 uint8_t func=0;
herenvarno 0:99767aa66bce 142 uint8_t button_mem=0;
herenvarno 0:99767aa66bce 143
herenvarno 3:4355890e55b4 144
herenvarno 3:4355890e55b4 145
herenvarno 0:99767aa66bce 146 uint8_t id;
herenvarno 0:99767aa66bce 147 float value1, value2;
herenvarno 3:4355890e55b4 148 char buffer0[16];
herenvarno 0:99767aa66bce 149 char buffer1[32], buffer2[32];
herenvarno 0:99767aa66bce 150 int32_t axes[3];
herenvarno 0:99767aa66bce 151 int16_t axxx[3];
herenvarno 0:99767aa66bce 152
herenvarno 3:4355890e55b4 153 /*
herenvarno 0:99767aa66bce 154
herenvarno 3:4355890e55b4 155 PersistorStorage ps=PersistorStorage();
herenvarno 3:4355890e55b4 156 strcpy(ps.storage, "hello");
herenvarno 3:4355890e55b4 157 ps.writeStorageToFlash();
herenvarno 0:99767aa66bce 158
herenvarno 3:4355890e55b4 159 PersistorStorage ps1=PersistorStorage();
herenvarno 3:4355890e55b4 160 ps1.ReadStorageFromFlash();
herenvarno 3:4355890e55b4 161
herenvarno 3:4355890e55b4 162 printf("%s", ps1.storage);
herenvarno 3:4355890e55b4 163 */
herenvarno 3:4355890e55b4 164 /*HAL_Init();
herenvarno 3:4355890e55b4 165 __HAL_FLASH_CLEAR_FLAG( FLASH_FLAG_EOP | FLASH_FLAG_OPERR |FLASH_FLAG_WRPERR | FLASH_FLAG_PGAERR | FLASH_FLAG_PGSERR );
herenvarno 3:4355890e55b4 166 printf("hello\n");
herenvarno 3:4355890e55b4 167 uint64_t a=124;
herenvarno 3:4355890e55b4 168 uint32_t pageerr = 100;
herenvarno 3:4355890e55b4 169 HAL_FLASH_Unlock();
herenvarno 3:4355890e55b4 170 FLASH_EraseInitTypeDef es;
herenvarno 3:4355890e55b4 171 es.TypeErase=FLASH_TYPEERASE_MASSERASE;
herenvarno 3:4355890e55b4 172 es.Banks=FLASH_BANK_2;
herenvarno 3:4355890e55b4 173 es.Page=0;
herenvarno 3:4355890e55b4 174 es.NbPages=1;
herenvarno 3:4355890e55b4 175
herenvarno 3:4355890e55b4 176 if( HAL_OK != (HAL_FLASHEx_Erase_IT( &es))) {
herenvarno 3:4355890e55b4 177 printf("ERROR %d\n", pageerr);
herenvarno 3:4355890e55b4 178 HAL_FLASH_Lock();
herenvarno 3:4355890e55b4 179 }
herenvarno 3:4355890e55b4 180 __HAL_FLASH_CLEAR_FLAG( FLASH_FLAG_EOP | FLASH_FLAG_OPERR |FLASH_FLAG_WRPERR | FLASH_FLAG_PGAERR | FLASH_FLAG_PGSERR );
herenvarno 3:4355890e55b4 181 HAL_FLASH_Unlock();
herenvarno 3:4355890e55b4 182 printf("%d\n", HAL_FLASH_Program(FLASH_TYPEPROGRAM_DOUBLEWORD, 0x08080000, a));
herenvarno 3:4355890e55b4 183 printf("hello\n");
herenvarno 3:4355890e55b4 184 printf("%d\n", HAL_FLASH_GetError());
herenvarno 3:4355890e55b4 185 HAL_FLASH_Lock();
herenvarno 3:4355890e55b4 186
herenvarno 3:4355890e55b4 187 static const int StorageSize = 64;
herenvarno 3:4355890e55b4 188 static unsigned int storage[ StorageSize ] __attribute__((aligned(32)));
herenvarno 3:4355890e55b4 189 HAL_FLASH_Unlock();
herenvarno 3:4355890e55b4 190 memcpy( (uint32_t*)storage, (uint32_t*)(0x08080000), StorageSize);
herenvarno 3:4355890e55b4 191 HAL_FLASH_Lock();
herenvarno 3:4355890e55b4 192
herenvarno 3:4355890e55b4 193 for(int i=0; i<StorageSize; i++)
herenvarno 3:4355890e55b4 194 {
herenvarno 3:4355890e55b4 195 printf("%4x ",storage[i]);
herenvarno 3:4355890e55b4 196 }
herenvarno 3:4355890e55b4 197 printf("\n");
herenvarno 3:4355890e55b4 198 */
herenvarno 0:99767aa66bce 199
herenvarno 3:4355890e55b4 200 /*
herenvarno 0:99767aa66bce 201 printf("\r\n--- Starting new run ---\r\n");
herenvarno 0:99767aa66bce 202
herenvarno 0:99767aa66bce 203 humidity_sensor->ReadID(&id);
herenvarno 0:99767aa66bce 204 printf("HTS221 humidity & temperature = 0x%X\r\n", id);
herenvarno 0:99767aa66bce 205 pressure_sensor->ReadID(&id);
herenvarno 0:99767aa66bce 206 printf("LPS25H pressure & temperature = 0x%X\r\n", id);
herenvarno 0:99767aa66bce 207 magnetometer->ReadID(&id);
herenvarno 0:99767aa66bce 208 printf("LIS3MDL magnetometer = 0x%X\r\n", id);
herenvarno 0:99767aa66bce 209 gyroscope->ReadID(&id);
herenvarno 0:99767aa66bce 210 printf("LSM6DS0 accelerometer & gyroscope = 0x%X\r\n", id);
herenvarno 3:4355890e55b4 211 */
herenvarno 5:100310ea8fba 212 float pressure=0;
herenvarno 3:4355890e55b4 213 while(1)
herenvarno 3:4355890e55b4 214 {
herenvarno 3:4355890e55b4 215 // MEASURE AND DISPLAY
herenvarno 3:4355890e55b4 216 if(mode==MODE_NORMAL)
herenvarno 3:4355890e55b4 217 {
herenvarno 3:4355890e55b4 218 myled=0;
herenvarno 3:4355890e55b4 219 if(func==FUNC_DATETIME)
herenvarno 3:4355890e55b4 220 {
herenvarno 3:4355890e55b4 221 myrawdata.__time=time(NULL);
herenvarno 3:4355890e55b4 222 myrawdata.str_date(buffer0);
herenvarno 3:4355890e55b4 223 myrawdata.str_time(buffer1);
herenvarno 3:4355890e55b4 224 }
herenvarno 3:4355890e55b4 225 else if(func==FUNC_TEMPHUMI)
herenvarno 3:4355890e55b4 226 {
herenvarno 3:4355890e55b4 227 temp_sensor1->GetTemperature(&myrawdata.__temp);
herenvarno 3:4355890e55b4 228 humidity_sensor->GetHumidity(&myrawdata.__humi);
herenvarno 3:4355890e55b4 229 myrawdata.str_temperature(buffer0);
herenvarno 3:4355890e55b4 230 myrawdata.str_humidity(buffer1);
herenvarno 3:4355890e55b4 231 }
herenvarno 5:100310ea8fba 232 else if(func==FUNC_ALTICDIR)
herenvarno 3:4355890e55b4 233 {
herenvarno 5:100310ea8fba 234 pressure_sensor->GetPressure(&pressure);
herenvarno 5:100310ea8fba 235 myrawdata.__prss = pressure * 10;
herenvarno 3:4355890e55b4 236 magnetometer->Get_M_Axes(myrawdata.__mag);
herenvarno 3:4355890e55b4 237 accelerometer->Get_X_Axes(myrawdata.__acc);
herenvarno 3:4355890e55b4 238 gyroscope->Get_G_Axes(myrawdata.__gyr);
herenvarno 5:100310ea8fba 239 myrawdata.str_altitude(buffer0);
herenvarno 3:4355890e55b4 240 myrawdata.str_direction(buffer1);
herenvarno 3:4355890e55b4 241 }
herenvarno 3:4355890e55b4 242 mydisplay.show(buffer0, buffer1);
herenvarno 3:4355890e55b4 243 }
herenvarno 5:100310ea8fba 244 else if(mode==MODE_CONFIG)
herenvarno 3:4355890e55b4 245 {
herenvarno 3:4355890e55b4 246 myled=1;
herenvarno 3:4355890e55b4 247 if(func==FUNC_DATETIME)
herenvarno 3:4355890e55b4 248 {
herenvarno 3:4355890e55b4 249 myrawdata.str_date(buffer0);
herenvarno 3:4355890e55b4 250 myrawdata.str_time(buffer1);
herenvarno 4:3fecfc9eeadd 251 if(flag_flash)
herenvarno 4:3fecfc9eeadd 252 {
herenvarno 4:3fecfc9eeadd 253 if(config_index==0)
herenvarno 4:3fecfc9eeadd 254 {
herenvarno 4:3fecfc9eeadd 255 buffer0[0]=0xff;
herenvarno 4:3fecfc9eeadd 256 }
herenvarno 4:3fecfc9eeadd 257 else if(config_index==1)
herenvarno 4:3fecfc9eeadd 258 {
herenvarno 4:3fecfc9eeadd 259 buffer0[1]=0xff;
herenvarno 4:3fecfc9eeadd 260 }
herenvarno 4:3fecfc9eeadd 261 else if(config_index==2)
herenvarno 4:3fecfc9eeadd 262 {
herenvarno 4:3fecfc9eeadd 263 buffer0[3]=0xff;
herenvarno 4:3fecfc9eeadd 264 buffer0[4]=0xff;
herenvarno 4:3fecfc9eeadd 265 }
herenvarno 4:3fecfc9eeadd 266 else if(config_index==3)
herenvarno 4:3fecfc9eeadd 267 {
herenvarno 4:3fecfc9eeadd 268 buffer0[6]=0xff;
herenvarno 4:3fecfc9eeadd 269 buffer0[7]=0xff;
herenvarno 4:3fecfc9eeadd 270 }
herenvarno 4:3fecfc9eeadd 271 else if(config_index==4)
herenvarno 4:3fecfc9eeadd 272 {
herenvarno 4:3fecfc9eeadd 273 buffer1[0]=0xff;
herenvarno 4:3fecfc9eeadd 274 buffer1[1]=0xff;
herenvarno 4:3fecfc9eeadd 275 }
herenvarno 4:3fecfc9eeadd 276 else if(config_index==5)
herenvarno 4:3fecfc9eeadd 277 {
herenvarno 4:3fecfc9eeadd 278 buffer1[3]=0xff;
herenvarno 4:3fecfc9eeadd 279 }
herenvarno 4:3fecfc9eeadd 280 else if(config_index==6)
herenvarno 4:3fecfc9eeadd 281 {
herenvarno 4:3fecfc9eeadd 282 buffer1[4]=0xff;
herenvarno 4:3fecfc9eeadd 283 }
herenvarno 4:3fecfc9eeadd 284 else if(config_index==7)
herenvarno 4:3fecfc9eeadd 285 {
herenvarno 4:3fecfc9eeadd 286 buffer1[6]=0xff;
herenvarno 4:3fecfc9eeadd 287 }
herenvarno 4:3fecfc9eeadd 288 else if(config_index==8)
herenvarno 4:3fecfc9eeadd 289 {
herenvarno 4:3fecfc9eeadd 290 buffer1[7]=0xff;
herenvarno 4:3fecfc9eeadd 291 }
herenvarno 4:3fecfc9eeadd 292 }
herenvarno 4:3fecfc9eeadd 293 }
herenvarno 4:3fecfc9eeadd 294 if(func==FUNC_TEMPHUMI)
herenvarno 4:3fecfc9eeadd 295 {
herenvarno 4:3fecfc9eeadd 296 myrawdata.str_temperature(buffer0);
herenvarno 4:3fecfc9eeadd 297 myrawdata.str_humidity(buffer1);
herenvarno 4:3fecfc9eeadd 298 if(flag_flash)
herenvarno 4:3fecfc9eeadd 299 {
herenvarno 4:3fecfc9eeadd 300 if(config_index==0)
herenvarno 4:3fecfc9eeadd 301 {
herenvarno 4:3fecfc9eeadd 302 buffer0[2]=0xff;
herenvarno 4:3fecfc9eeadd 303 }
herenvarno 4:3fecfc9eeadd 304 else if(config_index==1)
herenvarno 4:3fecfc9eeadd 305 {
herenvarno 4:3fecfc9eeadd 306 buffer0[3]=0xff;
herenvarno 4:3fecfc9eeadd 307 }
herenvarno 4:3fecfc9eeadd 308 else if(config_index==2)
herenvarno 4:3fecfc9eeadd 309 {
herenvarno 4:3fecfc9eeadd 310 buffer0[4]=0xff;
herenvarno 4:3fecfc9eeadd 311 }
herenvarno 4:3fecfc9eeadd 312 else if(config_index==3)
herenvarno 4:3fecfc9eeadd 313 {
herenvarno 4:3fecfc9eeadd 314 buffer0[6]=0xff;
herenvarno 4:3fecfc9eeadd 315 }
herenvarno 4:3fecfc9eeadd 316 else if(config_index==4)
herenvarno 4:3fecfc9eeadd 317 {
herenvarno 5:100310ea8fba 318 buffer1[3]=0xff;
herenvarno 4:3fecfc9eeadd 319 }
herenvarno 4:3fecfc9eeadd 320 else if(config_index==5)
herenvarno 4:3fecfc9eeadd 321 {
herenvarno 5:100310ea8fba 322 buffer1[4]=0xff;
herenvarno 4:3fecfc9eeadd 323 }
herenvarno 4:3fecfc9eeadd 324 else if(config_index==6)
herenvarno 4:3fecfc9eeadd 325 {
herenvarno 4:3fecfc9eeadd 326 buffer1[6]=0xff;
herenvarno 4:3fecfc9eeadd 327 }
herenvarno 4:3fecfc9eeadd 328 }
herenvarno 4:3fecfc9eeadd 329 }
herenvarno 5:100310ea8fba 330 else if(func==FUNC_ALTICDIR)
herenvarno 4:3fecfc9eeadd 331 {
herenvarno 5:100310ea8fba 332 myrawdata.str_altitude(buffer0);
herenvarno 4:3fecfc9eeadd 333 myrawdata.str_direction(buffer1);
herenvarno 5:100310ea8fba 334 if(flag_flash)
herenvarno 5:100310ea8fba 335 {
herenvarno 5:100310ea8fba 336 if(config_index==0)
herenvarno 5:100310ea8fba 337 {
herenvarno 5:100310ea8fba 338 buffer0[3]=0xff;
herenvarno 5:100310ea8fba 339 }
herenvarno 5:100310ea8fba 340 else if(config_index==1)
herenvarno 5:100310ea8fba 341 {
herenvarno 5:100310ea8fba 342 buffer0[4]=0xff;
herenvarno 5:100310ea8fba 343 }
herenvarno 5:100310ea8fba 344 else if(config_index==2)
herenvarno 5:100310ea8fba 345 {
herenvarno 5:100310ea8fba 346 buffer0[5]=0xff;
herenvarno 5:100310ea8fba 347 }
herenvarno 5:100310ea8fba 348 else if(config_index==3)
herenvarno 5:100310ea8fba 349 {
herenvarno 5:100310ea8fba 350 buffer0[6]=0xff;
herenvarno 5:100310ea8fba 351 }
herenvarno 5:100310ea8fba 352 }
herenvarno 4:3fecfc9eeadd 353 }
herenvarno 4:3fecfc9eeadd 354
herenvarno 4:3fecfc9eeadd 355 if(flag_flash)
herenvarno 4:3fecfc9eeadd 356 {
herenvarno 4:3fecfc9eeadd 357 flag_flash=0;
herenvarno 4:3fecfc9eeadd 358 }
herenvarno 4:3fecfc9eeadd 359 else
herenvarno 4:3fecfc9eeadd 360 {
herenvarno 4:3fecfc9eeadd 361 flag_flash=1;
herenvarno 3:4355890e55b4 362 }
herenvarno 3:4355890e55b4 363 mydisplay.show(buffer0, buffer1);
herenvarno 3:4355890e55b4 364 }
herenvarno 5:100310ea8fba 365 else
herenvarno 5:100310ea8fba 366 {
herenvarno 5:100310ea8fba 367 mydisplay.show("CALIBRATION", "START IN 3s ...");
herenvarno 5:100310ea8fba 368 wait(1);
herenvarno 5:100310ea8fba 369 mydisplay.show("CALIBRATION", "START IN 2s ...");
herenvarno 5:100310ea8fba 370 wait(1);
herenvarno 5:100310ea8fba 371 mydisplay.show("CALIBRATION", "START IN 1s ...");
herenvarno 5:100310ea8fba 372 wait(1);
herenvarno 5:100310ea8fba 373 mydisplay.show("CALIBRATION", "PHASE 1 ...");
herenvarno 5:100310ea8fba 374 int32_t acc[3]={0}, gyr[3]={0};
herenvarno 5:100310ea8fba 375 for(int i=0;i<100;i++)
herenvarno 5:100310ea8fba 376 {
herenvarno 5:100310ea8fba 377 int32_t acc_tmp[3]={0}, gyr_tmp[3]={0};
herenvarno 5:100310ea8fba 378 accelerometer->Get_X_Axes(acc_tmp);
herenvarno 5:100310ea8fba 379 gyroscope->Get_G_Axes(gyr_tmp);
herenvarno 5:100310ea8fba 380 acc[0] += acc_tmp[0];
herenvarno 5:100310ea8fba 381 acc[1] += acc_tmp[1];
herenvarno 5:100310ea8fba 382 acc[2] += acc_tmp[2];
herenvarno 5:100310ea8fba 383 gyr[0] += gyr_tmp[0];
herenvarno 5:100310ea8fba 384 gyr[1] += gyr_tmp[1];
herenvarno 5:100310ea8fba 385 gyr[2] += gyr_tmp[2];
herenvarno 5:100310ea8fba 386 wait(0.02);
herenvarno 5:100310ea8fba 387 }
herenvarno 5:100310ea8fba 388 myrawdata.__gyr_offset[0]=-gyr[0]/100;
herenvarno 5:100310ea8fba 389 myrawdata.__gyr_offset[1]=-gyr[1]/100;
herenvarno 5:100310ea8fba 390 myrawdata.__gyr_offset[2]=-gyr[2]/100;
herenvarno 5:100310ea8fba 391 myrawdata.__acc_offset[0]=-acc[0]/100;
herenvarno 5:100310ea8fba 392 myrawdata.__acc_offset[1]=-acc[1]/100;
herenvarno 5:100310ea8fba 393 myrawdata.__acc_offset[2]=1-acc[2]/100; // gravaty
herenvarno 5:100310ea8fba 394
herenvarno 5:100310ea8fba 395 mydisplay.show("CALIBRATION", "PHASE 2 ...");
herenvarno 5:100310ea8fba 396 int32_t mag_max[3]={-10000}, mag_min[3]={10000};
herenvarno 5:100310ea8fba 397 for(int i=0;i<500;i++)
herenvarno 5:100310ea8fba 398 {
herenvarno 5:100310ea8fba 399 int32_t mag_tmp[3]={0};
herenvarno 5:100310ea8fba 400 magnetometer->Get_M_Axes(mag_tmp);
herenvarno 5:100310ea8fba 401 mag_max[0]=mag_tmp[0]>mag_max[0]?mag_tmp[0]:mag_max[0];
herenvarno 5:100310ea8fba 402 mag_max[1]=mag_tmp[1]>mag_max[1]?mag_tmp[1]:mag_max[1];
herenvarno 5:100310ea8fba 403 mag_max[2]=mag_tmp[2]>mag_max[2]?mag_tmp[2]:mag_max[2];
herenvarno 5:100310ea8fba 404 mag_min[0]=mag_tmp[0]<mag_min[0]?mag_tmp[0]:mag_min[0];
herenvarno 5:100310ea8fba 405 mag_min[1]=mag_tmp[1]<mag_min[1]?mag_tmp[1]:mag_min[1];
herenvarno 5:100310ea8fba 406 mag_min[2]=mag_tmp[2]<mag_min[2]?mag_tmp[2]:mag_min[2];
herenvarno 5:100310ea8fba 407 wait(0.02);
herenvarno 5:100310ea8fba 408 }
herenvarno 5:100310ea8fba 409 myrawdata.__mag_offset[0]=-((mag_max[0]+mag_min[0])/2);
herenvarno 5:100310ea8fba 410 myrawdata.__mag_offset[1]=-((mag_max[1]+mag_min[1])/2);
herenvarno 5:100310ea8fba 411 myrawdata.__mag_offset[2]=-((mag_max[2]+mag_min[2])/2);
herenvarno 5:100310ea8fba 412
herenvarno 5:100310ea8fba 413 mode=MODE_NORMAL;
herenvarno 5:100310ea8fba 414 }
herenvarno 3:4355890e55b4 415
herenvarno 3:4355890e55b4 416 // NEXT STATE
herenvarno 3:4355890e55b4 417 if(mode==MODE_NORMAL)
herenvarno 3:4355890e55b4 418 {
herenvarno 5:100310ea8fba 419 if(fbtn==BTN_PRESSED_LONG)
herenvarno 3:4355890e55b4 420 {
herenvarno 3:4355890e55b4 421 mode=MODE_CONFIG;
herenvarno 3:4355890e55b4 422 }
herenvarno 3:4355890e55b4 423 else if(fbtn==BTN_PRESSED)
herenvarno 3:4355890e55b4 424 {
herenvarno 3:4355890e55b4 425 func=func+1;
herenvarno 5:100310ea8fba 426 if(func>FUNC_ALTICDIR)
herenvarno 3:4355890e55b4 427 func=FUNC_DATETIME;
herenvarno 3:4355890e55b4 428 }
herenvarno 5:100310ea8fba 429 else if(fbtn==BTN_PRESSED_VERY_LONG)
herenvarno 5:100310ea8fba 430 {
herenvarno 5:100310ea8fba 431 mode=MODE_CONFIG_AUTO;
herenvarno 5:100310ea8fba 432 }
herenvarno 3:4355890e55b4 433 }
herenvarno 5:100310ea8fba 434 else if(mode==MODE_CONFIG)
herenvarno 3:4355890e55b4 435 {
herenvarno 3:4355890e55b4 436 if(fbtn==BTN_PRESSED_VERY_LONG)
herenvarno 3:4355890e55b4 437 {
herenvarno 3:4355890e55b4 438 config_index=0;
herenvarno 3:4355890e55b4 439 mode=MODE_NORMAL;
herenvarno 3:4355890e55b4 440 }
herenvarno 3:4355890e55b4 441 else if(fbtn==BTN_PRESSED_LONG)
herenvarno 3:4355890e55b4 442 {
herenvarno 3:4355890e55b4 443 config_index+=1;
herenvarno 5:100310ea8fba 444 if(func==FUNC_DATETIME){
herenvarno 5:100310ea8fba 445 if(config_index>8)
herenvarno 5:100310ea8fba 446 {
herenvarno 5:100310ea8fba 447 config_index=0;
herenvarno 5:100310ea8fba 448 }
herenvarno 5:100310ea8fba 449 } else if(func== FUNC_TEMPHUMI){
herenvarno 5:100310ea8fba 450 if(config_index>6)
herenvarno 5:100310ea8fba 451 {
herenvarno 5:100310ea8fba 452 config_index=0;
herenvarno 5:100310ea8fba 453 }
herenvarno 5:100310ea8fba 454 } else if(func==FUNC_ALTICDIR){
herenvarno 5:100310ea8fba 455 if(config_index>3)
herenvarno 5:100310ea8fba 456 {
herenvarno 5:100310ea8fba 457 config_index=0;
herenvarno 5:100310ea8fba 458 }
herenvarno 4:3fecfc9eeadd 459 }
herenvarno 3:4355890e55b4 460 }
herenvarno 3:4355890e55b4 461 else if(fbtn==BTN_PRESSED)
herenvarno 3:4355890e55b4 462 {
herenvarno 3:4355890e55b4 463 if(func==FUNC_DATETIME)
herenvarno 3:4355890e55b4 464 {
herenvarno 3:4355890e55b4 465 if(config_index==0)
herenvarno 3:4355890e55b4 466 {
herenvarno 3:4355890e55b4 467 myrawdata.add_year_10();
herenvarno 3:4355890e55b4 468 }
herenvarno 3:4355890e55b4 469 else if(config_index==1)
herenvarno 3:4355890e55b4 470 {
herenvarno 3:4355890e55b4 471 myrawdata.add_year_1();
herenvarno 3:4355890e55b4 472 }
herenvarno 3:4355890e55b4 473 else if(config_index==2)
herenvarno 3:4355890e55b4 474 {
herenvarno 3:4355890e55b4 475 myrawdata.add_month();
herenvarno 3:4355890e55b4 476 }
herenvarno 3:4355890e55b4 477 else if(config_index==3)
herenvarno 3:4355890e55b4 478 {
herenvarno 3:4355890e55b4 479 myrawdata.add_day();
herenvarno 3:4355890e55b4 480 }
herenvarno 4:3fecfc9eeadd 481 else if(config_index==4)
herenvarno 4:3fecfc9eeadd 482 {
herenvarno 4:3fecfc9eeadd 483 myrawdata.add_hour();
herenvarno 4:3fecfc9eeadd 484 }
herenvarno 4:3fecfc9eeadd 485 else if(config_index==5)
herenvarno 4:3fecfc9eeadd 486 {
herenvarno 4:3fecfc9eeadd 487 myrawdata.add_min_10();
herenvarno 4:3fecfc9eeadd 488 }
herenvarno 4:3fecfc9eeadd 489 else if(config_index==6)
herenvarno 4:3fecfc9eeadd 490 {
herenvarno 4:3fecfc9eeadd 491 myrawdata.add_min_1();
herenvarno 4:3fecfc9eeadd 492 }
herenvarno 4:3fecfc9eeadd 493 else if(config_index==7)
herenvarno 4:3fecfc9eeadd 494 {
herenvarno 4:3fecfc9eeadd 495 myrawdata.add_sec_10();
herenvarno 4:3fecfc9eeadd 496 }
herenvarno 4:3fecfc9eeadd 497 else if(config_index==8)
herenvarno 4:3fecfc9eeadd 498 {
herenvarno 4:3fecfc9eeadd 499 myrawdata.add_sec_1();
herenvarno 4:3fecfc9eeadd 500 }
herenvarno 4:3fecfc9eeadd 501 }
herenvarno 5:100310ea8fba 502 else if(func==FUNC_TEMPHUMI)
herenvarno 4:3fecfc9eeadd 503 {
herenvarno 4:3fecfc9eeadd 504 if(config_index==0)
herenvarno 4:3fecfc9eeadd 505 {
herenvarno 4:3fecfc9eeadd 506 myrawdata.add_temp_sign();
herenvarno 4:3fecfc9eeadd 507 }
herenvarno 4:3fecfc9eeadd 508 else if(config_index==1)
herenvarno 4:3fecfc9eeadd 509 {
herenvarno 4:3fecfc9eeadd 510 myrawdata.add_temp_10();
herenvarno 4:3fecfc9eeadd 511 }
herenvarno 4:3fecfc9eeadd 512 else if(config_index==2)
herenvarno 4:3fecfc9eeadd 513 {
herenvarno 4:3fecfc9eeadd 514 myrawdata.add_temp_1();
herenvarno 4:3fecfc9eeadd 515 }
herenvarno 4:3fecfc9eeadd 516 else if(config_index==3)
herenvarno 4:3fecfc9eeadd 517 {
herenvarno 4:3fecfc9eeadd 518 myrawdata.add_temp_1_10();
herenvarno 4:3fecfc9eeadd 519 }
herenvarno 4:3fecfc9eeadd 520 else if(config_index==4)
herenvarno 4:3fecfc9eeadd 521 {
herenvarno 5:100310ea8fba 522 myrawdata.add_humi_10();
herenvarno 4:3fecfc9eeadd 523 }
herenvarno 4:3fecfc9eeadd 524 else if(config_index==5)
herenvarno 4:3fecfc9eeadd 525 {
herenvarno 5:100310ea8fba 526 myrawdata.add_humi_1();
herenvarno 4:3fecfc9eeadd 527 }
herenvarno 4:3fecfc9eeadd 528 else if(config_index==6)
herenvarno 4:3fecfc9eeadd 529 {
herenvarno 4:3fecfc9eeadd 530 myrawdata.add_humi_1_10();
herenvarno 4:3fecfc9eeadd 531 }
herenvarno 5:100310ea8fba 532 }
herenvarno 5:100310ea8fba 533 else if(func==FUNC_ALTICDIR)
herenvarno 5:100310ea8fba 534 {
herenvarno 5:100310ea8fba 535 if(config_index==0)
herenvarno 5:100310ea8fba 536 {
herenvarno 5:100310ea8fba 537 myrawdata.add_altitude_1000();
herenvarno 5:100310ea8fba 538 }
herenvarno 5:100310ea8fba 539 else if(config_index==1)
herenvarno 4:3fecfc9eeadd 540 {
herenvarno 5:100310ea8fba 541 myrawdata.add_altitude_100();
herenvarno 5:100310ea8fba 542 }
herenvarno 5:100310ea8fba 543 else if(config_index==2)
herenvarno 5:100310ea8fba 544 {
herenvarno 5:100310ea8fba 545 myrawdata.add_altitude_10();
herenvarno 5:100310ea8fba 546 }
herenvarno 5:100310ea8fba 547 else if(config_index==3)
herenvarno 5:100310ea8fba 548 {
herenvarno 5:100310ea8fba 549 myrawdata.add_altitude_1();
herenvarno 4:3fecfc9eeadd 550 }
herenvarno 3:4355890e55b4 551 }
herenvarno 3:4355890e55b4 552 }
herenvarno 3:4355890e55b4 553 }
herenvarno 5:100310ea8fba 554 else
herenvarno 5:100310ea8fba 555 {
herenvarno 5:100310ea8fba 556 ;
herenvarno 5:100310ea8fba 557 }
herenvarno 3:4355890e55b4 558
herenvarno 3:4355890e55b4 559 wait_action();
herenvarno 3:4355890e55b4 560 }
herenvarno 5:100310ea8fba 561
herenvarno 5:100310ea8fba 562 /*
herenvarno 3:4355890e55b4 563 raise_error(ERROR_CONFIG);
herenvarno 3:4355890e55b4 564
herenvarno 1:1df80fe13928 565 printf("START CALIBRATION\n");
herenvarno 1:1df80fe13928 566 int32_t m_max[3]={0};
herenvarno 1:1df80fe13928 567 int32_t m_min[3]={0};
herenvarno 1:1df80fe13928 568 for (int i=0; i<1000; i++)
herenvarno 1:1df80fe13928 569 {
herenvarno 1:1df80fe13928 570
herenvarno 1:1df80fe13928 571 magnetometer->Get_M_Axes(axes);
herenvarno 1:1df80fe13928 572 if(i==0)
herenvarno 1:1df80fe13928 573 {
herenvarno 1:1df80fe13928 574 for(int j=0; j<3; j++)
herenvarno 1:1df80fe13928 575 {
herenvarno 1:1df80fe13928 576 m_max[j]=axes[j];
herenvarno 1:1df80fe13928 577 m_min[j]=axes[j];
herenvarno 1:1df80fe13928 578 }
herenvarno 1:1df80fe13928 579 }
herenvarno 1:1df80fe13928 580 else
herenvarno 1:1df80fe13928 581 {
herenvarno 1:1df80fe13928 582 for(int j=0; j<3; j++)
herenvarno 1:1df80fe13928 583 {
herenvarno 1:1df80fe13928 584 if(axes[j]>m_max[j]) m_max[j]=axes[j];
herenvarno 1:1df80fe13928 585 if(axes[j]<m_min[j]) m_min[j]=axes[j];
herenvarno 1:1df80fe13928 586 }
herenvarno 1:1df80fe13928 587 }
herenvarno 1:1df80fe13928 588 wait(0.05);
herenvarno 1:1df80fe13928 589 }
herenvarno 1:1df80fe13928 590
herenvarno 1:1df80fe13928 591 printf("MAX : %d, %d, %d\n", m_max[0], m_max[1], m_max[2]);
herenvarno 1:1df80fe13928 592 printf("MIN : %d, %d, %d\n", m_min[0], m_min[1], m_min[2]);
herenvarno 1:1df80fe13928 593
herenvarno 0:99767aa66bce 594
herenvarno 0:99767aa66bce 595 while(1) {
herenvarno 0:99767aa66bce 596 if((mybutton!=0) && (button_mem==0))
herenvarno 0:99767aa66bce 597 {
herenvarno 0:99767aa66bce 598 func++;
herenvarno 0:99767aa66bce 599 if(func>=6)
herenvarno 0:99767aa66bce 600 func=0;
herenvarno 0:99767aa66bce 601 }
herenvarno 0:99767aa66bce 602 button_mem=mybutton;
herenvarno 0:99767aa66bce 603 printf("func: %d\r\n", func);
herenvarno 0:99767aa66bce 604 printf("\r\n");
herenvarno 0:99767aa66bce 605
herenvarno 0:99767aa66bce 606 if(func==0)
herenvarno 0:99767aa66bce 607 {
herenvarno 0:99767aa66bce 608 time_t seconds = time(NULL);
herenvarno 0:99767aa66bce 609 printf("Time as a basic string = %s\r\n", ctime(&seconds));
herenvarno 0:99767aa66bce 610 }
herenvarno 0:99767aa66bce 611 else if(func==1)
herenvarno 0:99767aa66bce 612 {
herenvarno 0:99767aa66bce 613 temp_sensor1->GetTemperature(&value1);
herenvarno 0:99767aa66bce 614 humidity_sensor->GetHumidity(&value2);
herenvarno 0:99767aa66bce 615
herenvarno 0:99767aa66bce 616 if(value2 > 70)
herenvarno 0:99767aa66bce 617 myled=1;
herenvarno 0:99767aa66bce 618 else
herenvarno 0:99767aa66bce 619 myled=0;
herenvarno 0:99767aa66bce 620 printf("HTS221: [temp] %7s C, [hum] %s%%\r\n", printDouble(buffer1, value1), printDouble(buffer2, value2));
herenvarno 0:99767aa66bce 621 }
herenvarno 0:99767aa66bce 622 else if(func==2)
herenvarno 0:99767aa66bce 623 {
herenvarno 0:99767aa66bce 624 temp_sensor2->GetFahrenheit(&value1);
herenvarno 0:99767aa66bce 625 pressure_sensor->GetPressure(&value2);
herenvarno 0:99767aa66bce 626 printf("LPS25H: [temp] %7s F, [press] %smbar\r\n", printDouble(buffer1, value1), printDouble(buffer2, value2));
herenvarno 0:99767aa66bce 627 printf("Altitude: %s m\r\n", printDouble(buffer1, 44300-44300*pow((value2/1013.25), 0.00019)));
herenvarno 0:99767aa66bce 628 }
herenvarno 0:99767aa66bce 629 else if(func==3)
herenvarno 0:99767aa66bce 630 {
herenvarno 0:99767aa66bce 631 magnetometer->Get_M_Axes(axes);
herenvarno 1:1df80fe13928 632 axxx[0]=axes[0]-((m_max[0]+m_min[0])/2);
herenvarno 1:1df80fe13928 633 axxx[1]=axes[1]-((m_max[1]+m_min[1])/2);
herenvarno 1:1df80fe13928 634 axxx[2]=axes[2]-((m_max[2]+m_min[2])/2);
herenvarno 0:99767aa66bce 635 printf("LIS3MDL [mag/mgauss]: %6ld, %6ld, %6ld\r\n", axxx[0], axxx[1], axxx[2]);
herenvarno 1:1df80fe13928 636 printf("DIR: %s deg\r\n", printDouble(buffer1, 90-atan(float(axxx[0])/float(axxx[1])/3.1416)));
herenvarno 0:99767aa66bce 637 }
herenvarno 0:99767aa66bce 638 else if(func==4)
herenvarno 0:99767aa66bce 639 {
herenvarno 0:99767aa66bce 640 accelerometer->Get_X_Axes(axes);
herenvarno 0:99767aa66bce 641 printf("LSM6DS0 [acc/mg]: %6ld, %6ld, %6ld\r\n", axes[0], axes[1], axes[2]);
herenvarno 0:99767aa66bce 642 }
herenvarno 0:99767aa66bce 643 else if(func==5)
herenvarno 0:99767aa66bce 644 {
herenvarno 0:99767aa66bce 645 gyroscope ->Get_G_Axes(axes);
herenvarno 0:99767aa66bce 646 printf("LSM6DS0 [gyro/mdps]: %6ld, %6ld, %6ld\r\n", axes[0], axes[1], axes[2]);
herenvarno 0:99767aa66bce 647 }
herenvarno 0:99767aa66bce 648 wait(1.5);
herenvarno 5:100310ea8fba 649 }*/
herenvarno 5:100310ea8fba 650
herenvarno 0:99767aa66bce 651 }