SAIT ARIS / LRAT-example-lorawan-REFACTOR-and-CLEAN-Branch

Important changes to repositories hosted on mbed.com

Mbed hosted mercurial repositories are deprecated and are due to be permanently deleted in July 2026.

To keep a copy of this software download the repository Zip archive or clone locally using Mercurial.

It is also possible to export all your personal repositories from the account settings page.

Dependencies:   Custom_LSM303 Custom_UBloxGPS LRAT-mbed-os USBDevice mbed-lora-radio-drv stm32EEPROM

Fork of LRAT-example-lorawan by SAIT ARIS

main.cpp@38:fd7a407bfe3e, 2018-08-30 (annotated)

Committer:
Huot87
Date:
Thu Aug 30 20:51:03 2018 +0000
Revision:
38:fd7a407bfe3e
Parent:
37:df69df1bcb1a
Child:
39:6da6cb44f22e
GPS Sleep/Awake functionality over I2C -- Awaiting Power draw test

Who changed what in which revision?

UserRevisionLine numberNew contents of line
mbed_official 0:7037ed05f54f 1 /**
mbed_official 0:7037ed05f54f 2 * Copyright (c) 2017, Arm Limited and affiliates.
mbed_official 0:7037ed05f54f 3 * SPDX-License-Identifier: Apache-2.0
mbed_official 0:7037ed05f54f 4 *
mbed_official 0:7037ed05f54f 5 * Licensed under the Apache License, Version 2.0 (the "License");
mbed_official 0:7037ed05f54f 6 * you may not use this file except in compliance with the License.
mbed_official 0:7037ed05f54f 7 * You may obtain a copy of the License at
mbed_official 0:7037ed05f54f 8 *
mbed_official 0:7037ed05f54f 9 * http://www.apache.org/licenses/LICENSE-2.0
mbed_official 0:7037ed05f54f 10 *
mbed_official 0:7037ed05f54f 11 * Unless required by applicable law or agreed to in writing, software
mbed_official 0:7037ed05f54f 12 * distributed under the License is distributed on an "AS IS" BASIS,
mbed_official 0:7037ed05f54f 13 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
mbed_official 0:7037ed05f54f 14 * See the License for the specific language governing permissions and
mbed_official 0:7037ed05f54f 15 * limitations under the License.
mbed_official 0:7037ed05f54f 16 */
lpeters 36:dcc6f89fa39a 17
lpeters 34:341fb423e74b 18 //#define TARGET_LRAT 1
lpeters 35:73b3963c6dd3 19 #define TARGET_DISCO1 1
lpeters 35:73b3963c6dd3 20 //#define TARGET_DISCO2 1
lpeters 34:341fb423e74b 21 //#define SENSOR_TEMP 1
lpeters 36:dcc6f89fa39a 22
lpeters 37:df69df1bcb1a 23 #define DCHILL 600 // Cycle delay in chill mode.
lpeters 37:df69df1bcb1a 24 #define DPANIC 60 // Cycle delay in panic mode.
lpeters 37:df69df1bcb1a 25 #define NPANIC 5 // Number of unprovoked panic cycles before cooldown.
lpeters 37:df69df1bcb1a 26
mbed_official 0:7037ed05f54f 27 #include <stdio.h>
tchari 30:ff249a9156dc 28 #include "mbed.h"
mbed_official 3:8c7198d1a2a1 29
mbed_official 0:7037ed05f54f 30 #include "lorawan/LoRaWANInterface.h"
mbed_official 0:7037ed05f54f 31 #include "lorawan/system/lorawan_data_structures.h"
mbed_official 0:7037ed05f54f 32 #include "events/EventQueue.h"
mbed_official 0:7037ed05f54f 33
mbed_official 0:7037ed05f54f 34 // Application helpers
mbed_official 0:7037ed05f54f 35 #include "DummySensor.h"
mbed_official 0:7037ed05f54f 36 #include "trace_helper.h"
mbed_official 0:7037ed05f54f 37 #include "lora_radio_helper.h"
mbed_official 0:7037ed05f54f 38
tchari 30:ff249a9156dc 39 #include "mbed-trace/mbed_trace.h"
tchari 30:ff249a9156dc 40 #define TRACE_GROUP "MAIN"
tchari 30:ff249a9156dc 41
mbed_official 0:7037ed05f54f 42 using namespace events;
mbed_official 0:7037ed05f54f 43
mbed_official 12:5015dfead3f2 44 // Max payload size can be LORAMAC_PHY_MAXPAYLOAD.
mbed_official 12:5015dfead3f2 45 // This example only communicates with much shorter messages (<30 bytes).
mbed_official 12:5015dfead3f2 46 // If longer messages are used, these buffers must be changed accordingly.
mbed_official 12:5015dfead3f2 47 uint8_t tx_buffer[30];
mbed_official 12:5015dfead3f2 48 uint8_t rx_buffer[30];
mbed_official 0:7037ed05f54f 49
mbed_official 0:7037ed05f54f 50 /*
mbed_official 0:7037ed05f54f 51 * Sets up an application dependent transmission timer in ms. Used only when Duty Cycling is off for testing
mbed_official 0:7037ed05f54f 52 */
mbed_official 0:7037ed05f54f 53 #define TX_TIMER 10000
mbed_official 0:7037ed05f54f 54
mbed_official 0:7037ed05f54f 55 /**
mbed_official 0:7037ed05f54f 56 * Maximum number of events for the event queue.
mbed_official 12:5015dfead3f2 57 * 10 is the safe number for the stack events, however, if application
mbed_official 0:7037ed05f54f 58 * also uses the queue for whatever purposes, this number should be increased.
mbed_official 0:7037ed05f54f 59 */
mbed_official 12:5015dfead3f2 60 #define MAX_NUMBER_OF_EVENTS 10
mbed_official 0:7037ed05f54f 61
mbed_official 0:7037ed05f54f 62 /**
mbed_official 0:7037ed05f54f 63 * Maximum number of retries for CONFIRMED messages before giving up
mbed_official 0:7037ed05f54f 64 */
tchari 30:ff249a9156dc 65 #define CONFIRMED_MSG_RETRY_COUNTER 15
mbed_official 0:7037ed05f54f 66
mbed_official 0:7037ed05f54f 67 /**
mbed_official 0:7037ed05f54f 68 * Dummy pin for dummy sensor
mbed_official 0:7037ed05f54f 69 */
mbed_official 0:7037ed05f54f 70 #define PC_9 0
mbed_official 0:7037ed05f54f 71
mbed_official 0:7037ed05f54f 72 /**
mbed_official 0:7037ed05f54f 73 * Dummy sensor class object
mbed_official 0:7037ed05f54f 74 */
mbed_official 0:7037ed05f54f 75 DS1820 ds1820(PC_9);
mbed_official 0:7037ed05f54f 76
mbed_official 0:7037ed05f54f 77 /**
mbed_official 0:7037ed05f54f 78 * This event queue is the global event queue for both the
mbed_official 0:7037ed05f54f 79 * application and stack. To conserve memory, the stack is designed to run
mbed_official 0:7037ed05f54f 80 * in the same thread as the application and the application is responsible for
mbed_official 0:7037ed05f54f 81 * providing an event queue to the stack that will be used for ISR deferment as
mbed_official 0:7037ed05f54f 82 * well as application information event queuing.
mbed_official 0:7037ed05f54f 83 */
mbed_official 0:7037ed05f54f 84 static EventQueue ev_queue(MAX_NUMBER_OF_EVENTS * EVENTS_EVENT_SIZE);
mbed_official 0:7037ed05f54f 85
mbed_official 0:7037ed05f54f 86 /**
mbed_official 0:7037ed05f54f 87 * Event handler.
mbed_official 0:7037ed05f54f 88 *
mbed_official 0:7037ed05f54f 89 * This will be passed to the LoRaWAN stack to queue events for the
mbed_official 0:7037ed05f54f 90 * application which in turn drive the application.
mbed_official 0:7037ed05f54f 91 */
mbed_official 0:7037ed05f54f 92 static void lora_event_handler(lorawan_event_t event);
mbed_official 0:7037ed05f54f 93
mbed_official 0:7037ed05f54f 94 /**
mbed_official 2:dc95ac6d6d4e 95 * Constructing Mbed LoRaWANInterface and passing it down the radio object.
mbed_official 0:7037ed05f54f 96 */
mbed_official 2:dc95ac6d6d4e 97 static LoRaWANInterface lorawan(radio);
mbed_official 0:7037ed05f54f 98
mbed_official 0:7037ed05f54f 99 /**
mbed_official 0:7037ed05f54f 100 * Application specific callbacks
mbed_official 0:7037ed05f54f 101 */
mbed_official 0:7037ed05f54f 102 static lorawan_app_callbacks_t callbacks;
mbed_official 0:7037ed05f54f 103
lpeters 35:73b3963c6dd3 104 /*
lpeters 35:73b3963c6dd3 105 #if defined(TARGET_LRAT) or defined(TARGET_DISCO2)
lpeters 34:341fb423e74b 106 #include "USBSerial.h"
lpeters 34:341fb423e74b 107 USBSerial serial;
lpeters 34:341fb423e74b 108 FileHandle* mbed::mbed_override_console(int) {
lpeters 34:341fb423e74b 109 return &serial;
lpeters 34:341fb423e74b 110 }
lpeters 34:341fb423e74b 111 #endif
lpeters 35:73b3963c6dd3 112 */
lpeters 34:341fb423e74b 113
lpeters 35:73b3963c6dd3 114 uint32_t mytime = 0;
lpeters 35:73b3963c6dd3 115 uint8_t mybatt = 0;
lpeters 35:73b3963c6dd3 116 double mylat = 0;
lpeters 35:73b3963c6dd3 117 double mylon = 0;
lpeters 33:e47306c32791 118
lpeters 33:e47306c32791 119 int16_t myAccX = 0;
lpeters 33:e47306c32791 120 int16_t myAccY = 0;
lpeters 33:e47306c32791 121 int16_t myAccZ = 0;
lpeters 33:e47306c32791 122 int16_t myMagX = 0;
lpeters 33:e47306c32791 123 int16_t myMagY = 0;
lpeters 33:e47306c32791 124 int16_t myMagZ = 0;
lpeters 33:e47306c32791 125 int16_t myOffX = 0;
lpeters 33:e47306c32791 126 int16_t myOffY = 0;
lpeters 33:e47306c32791 127 int16_t myOffZ = 0;
lpeters 33:e47306c32791 128 int16_t myTemp = 0;
lpeters 33:e47306c32791 129
lpeters 33:e47306c32791 130 int16_t accMinX = 0;
lpeters 33:e47306c32791 131 int16_t accMinY = 0;
lpeters 33:e47306c32791 132 int16_t accMinZ = 0;
lpeters 33:e47306c32791 133 int16_t accMaxX = 0;
lpeters 33:e47306c32791 134 int16_t accMaxY = 0;
lpeters 33:e47306c32791 135 int16_t accMaxZ = 0;
lpeters 33:e47306c32791 136
lpeters 33:e47306c32791 137 int16_t magMinX = 0;
lpeters 33:e47306c32791 138 int16_t magMinY = 0;
lpeters 33:e47306c32791 139 int16_t magMinZ = 0;
lpeters 33:e47306c32791 140 int16_t magMaxX = 0;
lpeters 33:e47306c32791 141 int16_t magMaxY = 0;
lpeters 33:e47306c32791 142 int16_t magMaxZ = 0;
lpeters 33:e47306c32791 143
lpeters 33:e47306c32791 144 #define NEOM8M_ADR_GPS 0x84
lpeters 34:341fb423e74b 145 //#define LSM303_ADR_ACC 0x32
lpeters 33:e47306c32791 146 #define LSM303_ADR_MAG 0x3C
tchari 30:ff249a9156dc 147
lpeters 33:e47306c32791 148 #define NEOM8M_REG_GPS_LENH 0xFD
lpeters 33:e47306c32791 149 #define NEOM8M_REG_GPS_LENL 0xFE
lpeters 33:e47306c32791 150 #define NEOM8M_REG_GPS_DATA 0xFE
lpeters 33:e47306c32791 151 #define LSM303_REG_ACC_STATUS_REG_AUX_A 0x07
lpeters 34:341fb423e74b 152 //#define LSM303_REG_ACC_OUT_TEMP_L_A 0x0C
lpeters 34:341fb423e74b 153 //#define LSM303_REG_ACC_OUT_TEMP_H_A 0x0D
lpeters 33:e47306c32791 154 #define LSM303_REG_ACC_WHO_AM_I_A 0x0F
lpeters 34:341fb423e74b 155 //#define LSM303_REG_ACC_TEMP_CFG_REG_A 0x1F
lpeters 33:e47306c32791 156 #define LSM303_REG_ACC_CTRL_REG1_A 0x20
lpeters 33:e47306c32791 157 #define LSM303_REG_ACC_CTRL_REG2_A 0x21
lpeters 33:e47306c32791 158 #define LSM303_REG_ACC_CTRL_REG3_A 0x22
lpeters 33:e47306c32791 159 #define LSM303_REG_ACC_CTRL_REG4_A 0x23
lpeters 33:e47306c32791 160 #define LSM303_REG_ACC_CTRL_REG5_A 0x24
lpeters 34:341fb423e74b 161 #define LSM303_REG_ACC_CTRL_REG6_A 0x25
lpeters 33:e47306c32791 162 #define LSM303_REG_ACC_STATUS_REG_A 0x27
lpeters 33:e47306c32791 163 #define LSM303_REG_ACC_OUT_X_L_A 0x28
lpeters 33:e47306c32791 164 #define LSM303_REG_ACC_OUT_X_H_A 0x29
lpeters 33:e47306c32791 165 #define LSM303_REG_ACC_OUT_Y_L_A 0x2A
lpeters 33:e47306c32791 166 #define LSM303_REG_ACC_OUT_Y_H_A 0x2B
lpeters 33:e47306c32791 167 #define LSM303_REG_ACC_OUT_Z_L_A 0x2C
lpeters 33:e47306c32791 168 #define LSM303_REG_ACC_OUT_Z_H_A 0x2D
lpeters 33:e47306c32791 169 #define LSM303_REG_ACC_INT1_CFG_A 0x30
lpeters 33:e47306c32791 170 #define LSM303_REG_ACC_INT1_SRC_A 0x31
lpeters 33:e47306c32791 171 #define LSM303_REG_ACC_INT1_THS_A 0x32
lpeters 33:e47306c32791 172 #define LSM303_REG_ACC_INT1_DURATION_A 0x33
lpeters 35:73b3963c6dd3 173
lpeters 33:e47306c32791 174 #define LSM303_REG_MAG_OFFSET_X_REG_L_M 0x45
lpeters 33:e47306c32791 175 #define LSM303_REG_MAG_OFFSET_X_REG_H_M 0x46
lpeters 33:e47306c32791 176 #define LSM303_REG_MAG_OFFSET_Y_REG_L_M 0x47
lpeters 33:e47306c32791 177 #define LSM303_REG_MAG_OFFSET_Y_REG_H_M 0x48
lpeters 33:e47306c32791 178 #define LSM303_REG_MAG_OFFSET_Z_REG_L_M 0x49
lpeters 33:e47306c32791 179 #define LSM303_REG_MAG_OFFSET_Z_REG_H_M 0x4A
lpeters 34:341fb423e74b 180 //#define LSM303_REG_MAG_WHO_AM_I_M 0x4F
lpeters 34:341fb423e74b 181 //#define LSM303_REG_MAG_CFG_REG_A_M 0x60
lpeters 34:341fb423e74b 182 //#define LSM303_REG_MAG_CFG_REG_B_M 0x61
lpeters 34:341fb423e74b 183 //#define LSM303_REG_MAG_CFG_REG_C_M 0x62
lpeters 33:e47306c32791 184 #define LSM303_REG_MAG_INT_CTRL_REG_M 0x63
lpeters 33:e47306c32791 185 #define LSM303_REG_MAG_INT_SOURCE_REG_M 0x64
lpeters 33:e47306c32791 186 #define LSM303_REG_MAG_INT_THS_L_REG_M 0x65
lpeters 33:e47306c32791 187 #define LSM303_REG_MAG_INT_THS_H_REG_M 0x66
lpeters 34:341fb423e74b 188 //#define LSM303_REG_MAG_STATUS_REG_M 0x67
lpeters 34:341fb423e74b 189 //#define LSM303_REG_MAG_OUTX_L_REG_M 0x68
lpeters 34:341fb423e74b 190 //#define LSM303_REG_MAG_OUTX_H_REG_M 0x69
lpeters 34:341fb423e74b 191 //#define LSM303_REG_MAG_OUTY_L_REG_M 0x6A
lpeters 34:341fb423e74b 192 //#define LSM303_REG_MAG_OUTY_H_REG_M 0x6B
lpeters 34:341fb423e74b 193 //#define LSM303_REG_MAG_OUTZ_L_REG_M 0x6C
lpeters 34:341fb423e74b 194 //#define LSM303_REG_MAG_OUTZ_H_REG_M 0x6D
lpeters 33:e47306c32791 195
lpeters 35:73b3963c6dd3 196 #define EEPROM_MAX 0x17FF
lpeters 35:73b3963c6dd3 197
lpeters 34:341fb423e74b 198 #if defined(TARGET_LRAT)
lpeters 34:341fb423e74b 199 #define LEDR PB_6
lpeters 34:341fb423e74b 200 #define LEDG PB_7
lpeters 34:341fb423e74b 201 #define LEDB PB_5
lpeters 34:341fb423e74b 202 #define LEDW PB_2
lpeters 35:73b3963c6dd3 203 #define PIN_ACC PB_14
lpeters 35:73b3963c6dd3 204 #define PIN_MAG PB_12
lpeters 35:73b3963c6dd3 205 #define PIN_BTN PA_5
lpeters 35:73b3963c6dd3 206 #define PIN_ALT PA_4
lpeters 34:341fb423e74b 207 #define LSM303_ADR_ACC 0x3A
lpeters 34:341fb423e74b 208 #define LSM303_REG_MAG_WHO_AM_I_M 0x0F
lpeters 34:341fb423e74b 209 #define LSM303_WHO_ACC 0x41
lpeters 34:341fb423e74b 210 #define LSM303_WHO_MAG 0x3D
lpeters 34:341fb423e74b 211 #define LSM303_CTRL_REG7_A 0x26
lpeters 34:341fb423e74b 212 #define LSM303_REG_MAG_CTRL_REG1_M 0x20
lpeters 34:341fb423e74b 213 #define LSM303_REG_MAG_CTRL_REG2_M 0x21
lpeters 34:341fb423e74b 214 #define LSM303_REG_MAG_CTRL_REG3_M 0x22
lpeters 34:341fb423e74b 215 #define LSM303_REG_MAG_CTRL_REG4_M 0x23
lpeters 34:341fb423e74b 216 #define LSM303_REG_MAG_CTRL_REG5_M 0x24
lpeters 34:341fb423e74b 217 #define LSM303_REG_MAG_STATUS_REG_M 0x27
lpeters 34:341fb423e74b 218 #define LSM303_REG_MAG_OUTX_L_REG_M 0x28
lpeters 34:341fb423e74b 219 #define LSM303_REG_MAG_OUTX_H_REG_M 0x29
lpeters 34:341fb423e74b 220 #define LSM303_REG_MAG_OUTY_L_REG_M 0x2A
lpeters 34:341fb423e74b 221 #define LSM303_REG_MAG_OUTY_H_REG_M 0x2B
lpeters 34:341fb423e74b 222 #define LSM303_REG_MAG_OUTZ_L_REG_M 0x2C
lpeters 34:341fb423e74b 223 #define LSM303_REG_MAG_OUTZ_H_REG_M 0x2D
lpeters 34:341fb423e74b 224 #define LSM303_REG_MAG_TEMP_L_M 0x2E
lpeters 34:341fb423e74b 225 #define LSM303_REG_MAG_TEMP_H_M 0x2F
lpeters 34:341fb423e74b 226 #define LSM303_REG_MAG_TEMP_CFG_REG_A 0x1F
lpeters 34:341fb423e74b 227 #define CFG_ACC_ADR LSM303_REG_ACC_CTRL_REG1_A
lpeters 34:341fb423e74b 228 #define CFG_ACC_LEN 7
lpeters 34:341fb423e74b 229 #define CFG_MAG_ADR LSM303_REG_MAG_CTRL_REG1_M
lpeters 34:341fb423e74b 230 #define CFG_MAG_LEN 5
lpeters 34:341fb423e74b 231 #else
lpeters 34:341fb423e74b 232 #define LEDR PB_7
lpeters 34:341fb423e74b 233 #define LEDG PB_5
lpeters 34:341fb423e74b 234 #define LEDB PB_6
lpeters 34:341fb423e74b 235 #define LEDW PA_5
lpeters 35:73b3963c6dd3 236 #define PIN_ACC PB_14 // Not really.
lpeters 35:73b3963c6dd3 237 #if defined(TARGET_DISCO2)
lpeters 35:73b3963c6dd3 238 #define PIN_MAG PB_13
lpeters 37:df69df1bcb1a 239 #define PIN_GPS PA_10
lpeters 35:73b3963c6dd3 240 #else
lpeters 35:73b3963c6dd3 241 #define PIN_MAG PA_10
lpeters 37:df69df1bcb1a 242 #define PIN_GPS PB_13
lpeters 35:73b3963c6dd3 243 #endif
lpeters 35:73b3963c6dd3 244 #define PIN_BTN PB_2
lpeters 34:341fb423e74b 245 #define LSM303_ADR_ACC 0x32
lpeters 34:341fb423e74b 246 #define LSM303_REG_MAG_WHO_AM_I_M 0x4F
lpeters 34:341fb423e74b 247 #define LSM303_WHO_ACC 0x33
lpeters 34:341fb423e74b 248 #define LSM303_WHO_MAG 0x40
lpeters 34:341fb423e74b 249 #define LSM303_REG_ACC_OUT_TEMP_L_A 0x0C
lpeters 34:341fb423e74b 250 #define LSM303_REG_ACC_OUT_TEMP_H_A 0x0D
lpeters 34:341fb423e74b 251 #define LSM303_REG_ACC_TEMP_CFG_REG_A 0x1F
lpeters 34:341fb423e74b 252 #define LSM303_REG_MAG_CFG_REG_A_M 0x60
lpeters 34:341fb423e74b 253 #define LSM303_REG_MAG_CFG_REG_B_M 0x61
lpeters 34:341fb423e74b 254 #define LSM303_REG_MAG_CFG_REG_C_M 0x62
lpeters 34:341fb423e74b 255 #define LSM303_REG_MAG_STATUS_REG_M 0x67
lpeters 34:341fb423e74b 256 #define LSM303_REG_MAG_OUTX_L_REG_M 0x68
lpeters 34:341fb423e74b 257 #define LSM303_REG_MAG_OUTX_H_REG_M 0x69
lpeters 34:341fb423e74b 258 #define LSM303_REG_MAG_OUTY_L_REG_M 0x6A
lpeters 34:341fb423e74b 259 #define LSM303_REG_MAG_OUTY_H_REG_M 0x6B
lpeters 34:341fb423e74b 260 #define LSM303_REG_MAG_OUTZ_L_REG_M 0x6C
lpeters 34:341fb423e74b 261 #define LSM303_REG_MAG_OUTZ_H_REG_M 0x6D
lpeters 34:341fb423e74b 262 #define CFG_ACC_ADR LSM303_REG_ACC_TEMP_CFG_REG_A // Start Disco at TEMP CFG.
lpeters 34:341fb423e74b 263 #define CFG_ACC_LEN 7
lpeters 34:341fb423e74b 264 #define CFG_MAG_ADR LSM303_REG_MAG_CFG_REG_A_M
lpeters 34:341fb423e74b 265 #define CFG_MAG_LEN 3
lpeters 34:341fb423e74b 266 #endif
tchari 30:ff249a9156dc 267
tchari 30:ff249a9156dc 268 I2C i2c(PB_9, PB_8);
lpeters 35:73b3963c6dd3 269 InterruptIn accPin(PIN_ACC);
lpeters 35:73b3963c6dd3 270 InterruptIn magPin(PIN_MAG);
lpeters 35:73b3963c6dd3 271 InterruptIn btnPin(PIN_BTN);
lpeters 33:e47306c32791 272
lpeters 37:df69df1bcb1a 273 #if defined(TARGET_DISCO1) or defined(TARGET_DISCO2)
lpeters 37:df69df1bcb1a 274 DigitalOut gpsPin(PIN_GPS);
lpeters 37:df69df1bcb1a 275 #endif
lpeters 37:df69df1bcb1a 276
lpeters 35:73b3963c6dd3 277 uint8_t cfg;
lpeters 33:e47306c32791 278 char ret;
lpeters 33:e47306c32791 279 char rda = '\0';
lpeters 33:e47306c32791 280 char cmd[2];
lpeters 37:df69df1bcb1a 281 //char buf[83];
lpeters 37:df69df1bcb1a 282 char buf[192];
lpeters 35:73b3963c6dd3 283 uint8_t pos = 0;
lpeters 35:73b3963c6dd3 284
lpeters 33:e47306c32791 285 int accShift = 0;
lpeters 33:e47306c32791 286 int accScale = 0;
lpeters 33:e47306c32791 287 int accEvent = 0;
lpeters 35:73b3963c6dd3 288 uint8_t accSFire = 0;
lpeters 35:73b3963c6dd3 289 uint8_t accHFire = 0;
lpeters 35:73b3963c6dd3 290 uint8_t accSLIRQ = 0;
lpeters 35:73b3963c6dd3 291 uint8_t accSHIRQ = 0;
lpeters 33:e47306c32791 292 int magEvent = 0;
lpeters 35:73b3963c6dd3 293 uint8_t magSFire = 0;
lpeters 35:73b3963c6dd3 294 uint8_t magHFire = 0;
lpeters 35:73b3963c6dd3 295 uint8_t magSLIRQ = 0;
lpeters 35:73b3963c6dd3 296 uint8_t magSHIRQ = 0;
lpeters 35:73b3963c6dd3 297 uint8_t btnHFire = 0;
lpeters 33:e47306c32791 298
lpeters 35:73b3963c6dd3 299 char *res;
lpeters 35:73b3963c6dd3 300 char sPass[26] = "[\u001b[32mPASS\u001b[0m]";
lpeters 35:73b3963c6dd3 301 char sFail[26] = "[\u001b[31mFAIL\u001b[0m]";
lpeters 33:e47306c32791 302 char cmdSendLoop[9] = "SendLoop";
lpeters 37:df69df1bcb1a 303 //char cmdStopGNSS[14] = {0xB5, 0x62, 0x06, 0x57, 0x08, 0x00, 0x00, 0x00, 0x00, 0x00, 0x53, 0x54, 0x4F, 0x50};
lpeters 37:df69df1bcb1a 304
lpeters 37:df69df1bcb1a 305 //#define CMDSTOPGNSS {0xFF, 0xB5, 0x62, 0x06, 0x57, 0x08, 0x00, 0x00, 0x00, 0x00, 0x00, 0x53, 0x54, 0x4F, 0x50}
lpeters 37:df69df1bcb1a 306 //char cmdStopGNSS[16] {0xB5, 0x62, 0x06, 0x57, 0x08, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}; // Leave 2 bytes for CRC.
lpeters 37:df69df1bcb1a 307 //char cmdStopGNSS[16] {0xB5, 0x62, 0x06, 0x57, 0x08, 0x00, 0x01, 0x00, 0x00, 0x00, 0x53, 0x54, 0x4F, 0x50}; // Leave 2 bytes for CRC.
Huot87 38:fd7a407bfe3e 308 char cmdStopGNSS[16] {0xB5, 0x62, 0x06, 0x57, 0x08, 0x00, 0x01, 0x00, 0x00, 0x00, 0x50, 0x4F, 0x54, 0x53}; // Leave 2 bytes for CRC. // Note Byte character is Little Endian from what doc says
lpeters 37:df69df1bcb1a 309 char cmdReadGNSS[8] {0xB5, 0x62, 0x06, 0x57, 0x00, 0x00};
lpeters 37:df69df1bcb1a 310 char cmdReadCfgU[8] {0xB5, 0x62, 0x06, 0x1B, 0x00, 0x00}; // Leave 2 bytes for CRC.
lpeters 37:df69df1bcb1a 311 char cmdPollPort[9] {0xB5, 0x62, 0x06, 0x00, 0x01, 0x00, 0x00};
lpeters 33:e47306c32791 312
Huot87 38:fd7a407bfe3e 313 // HUOT Additions - 08/29/18
Huot87 38:fd7a407bfe3e 314 // UBX-CFG-GNSS -- Disable Glonass (also leave 2 bytes)
Huot87 38:fd7a407bfe3e 315 char cmdDisableGLONASS[68] {0xB5, 0x62, 0x06, 0x3E, 0x3C, 0x00, 0x00, 0x20, 0x20, 0x07, 0x00, 0x08, 0x10, 0x00, 0x01, 0x00, 0x01, 0x01, 0x01, 0x01, 0x03, 0x00, 0x01, 0x00, 0x01, 0x01, 0x02, 0x04, 0x08, 0x00, 0x00, 0x00, 0x01, 0x01, 0x03, 0x08, 0x10, 0x00, 0x00, 0x00, 0x01, 0x01, 0x04, 0x00, 0x08, 0x00, 0x00, 0x00, 0x01, 0x03, 0x05, 0x00, 0x03, 0x00, 0x01, 0x00, 0x01, 0x05, 0x06, 0x08, 0x0E, 0x00, 0x01, 0x00, 0x01, 0x01};
Huot87 38:fd7a407bfe3e 316 // UBX-CFG-TP5 -- Disable Timepulse (also leave 2 bytes)
Huot87 38:fd7a407bfe3e 317 char cmdDisableTimePulse[40] {0xB5, 0x62, 0x06, 0x31, 0x20, 0x00, 0x00, 0x01, 0x00, 0x00, 0x32, 0x00, 0x00, 0x00, 0x40, 0x42, 0x0F, 0x00, 0x40, 0x42, 0x0F, 0x00, 0x00, 0x00, 0x00, 0x00, 0xA0, 0x86, 0x01, 0x00, 0x00, 0x00, 0x00, 0x00, 0x76, 0x00, 0x00, 0x00};
Huot87 38:fd7a407bfe3e 318 // UBX-CFG-PM2 -- Configure Power Management Setup (also leave 2 bytes)
Huot87 38:fd7a407bfe3e 319 char cmdConfigPMS[52] {0xB5, 0x62, 0x06, 0x3B, 0x2C, 0x00, 0x01, 0x06, 0x00, 0x00, 0x2E, 0x08, 0x40, 0x01, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x2C, 0x01, 0x00, 0x00, 0x4F, 0xC1, 0x03, 0x00, 0x86, 0x02, 0x00, 0x00, 0xFE, 0x00, 0x00, 0x00, 0x64, 0x40, 0x01, 0x00, 0x56, 0xA4};
Huot87 38:fd7a407bfe3e 320 char cmdSaveConfig[21] {0xB5, 0x62, 0x06, 0x09, 0x0D, 0x00, 0x00, 0x00, 0x00, 0x00, 0xFF, 0xFF, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x03}; // UBX-CFG-CFG -- Save Configuration (also leave 2 bytes)
Huot87 38:fd7a407bfe3e 321 char cmdResetDefaults[21] {0xB5, 0x62, 0x06, 0x09, 0x0D, 0x00, 0xFF, 0xFF, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xFF, 0xFF, 0x00, 0x00, 0x03}; // UBX-CFG-CFG -- Reset to Defaults (also leave 2 bytes)
Huot87 38:fd7a407bfe3e 322
Huot87 38:fd7a407bfe3e 323 // THIS WORKS
Huot87 38:fd7a407bfe3e 324 char secondTimeSleep[12] {0xB5, 0x62, 0x06, 0x04, 0x04, 0x00, 0x00, 0x00,0x08, 0x00};
Huot87 38:fd7a407bfe3e 325 char secondTimeAwake[12] {0xB5, 0x62, 0x06, 0x04, 0x04, 0x00, 0x00, 0x00,0x09, 0x00};
Huot87 38:fd7a407bfe3e 326
lpeters 35:73b3963c6dd3 327 time_t tInit = 0;
lpeters 35:73b3963c6dd3 328 time_t tBump = 0;
lpeters 35:73b3963c6dd3 329 time_t tLast = 0;
lpeters 35:73b3963c6dd3 330 time_t tNext = 0;
lpeters 36:dcc6f89fa39a 331 time_t tSend = 0;
lpeters 37:df69df1bcb1a 332 time_t tCalm = 0;
lpeters 35:73b3963c6dd3 333
lpeters 34:341fb423e74b 334 DigitalOut myLedR(LEDR);
lpeters 34:341fb423e74b 335 DigitalOut myLedG(LEDG);
lpeters 34:341fb423e74b 336 DigitalOut myLedB(LEDB);
lpeters 34:341fb423e74b 337 DigitalOut myLedW(LEDW);
lpeters 34:341fb423e74b 338
lpeters 34:341fb423e74b 339 void magInitSequence();
lpeters 34:341fb423e74b 340 void accInitSequence();
lpeters 34:341fb423e74b 341 void gpsInitSequence();
Huot87 38:fd7a407bfe3e 342 void gpsExecuteCommand(char *command, int length);
lpeters 34:341fb423e74b 343 void tmpRead();
lpeters 34:341fb423e74b 344 void magRead();
lpeters 34:341fb423e74b 345 void accRead();
Huot87 38:fd7a407bfe3e 346 int gpsRead();
lpeters 37:df69df1bcb1a 347 void ubxRead();
lpeters 36:dcc6f89fa39a 348 void send_message();
lpeters 34:341fb423e74b 349
lpeters 35:73b3963c6dd3 350 void onBtnIrq()
lpeters 35:73b3963c6dd3 351 {
lpeters 35:73b3963c6dd3 352 btnHFire++;
lpeters 36:dcc6f89fa39a 353 tSend = 0;
lpeters 35:73b3963c6dd3 354 }
lpeters 35:73b3963c6dd3 355
lpeters 33:e47306c32791 356 void onAccIrq()
lpeters 33:e47306c32791 357 {
lpeters 33:e47306c32791 358 accHFire++;
lpeters 36:dcc6f89fa39a 359 tSend = 0;
lpeters 33:e47306c32791 360 }
lpeters 33:e47306c32791 361
lpeters 33:e47306c32791 362 void onMagIrq()
lpeters 33:e47306c32791 363 {
lpeters 33:e47306c32791 364 magHFire++;
lpeters 36:dcc6f89fa39a 365 tSend = 0;
lpeters 33:e47306c32791 366 }
lpeters 33:e47306c32791 367
lpeters 33:e47306c32791 368 void accDumpCfg()
lpeters 33:e47306c32791 369 {
lpeters 34:341fb423e74b 370 char start = CFG_ACC_ADR;
lpeters 34:341fb423e74b 371 for (int i = 0; i < CFG_ACC_LEN; i++)
lpeters 33:e47306c32791 372 {
lpeters 33:e47306c32791 373 cmd[0] = start + i;
lpeters 33:e47306c32791 374 i2c.write(LSM303_ADR_ACC, cmd, 1);
lpeters 33:e47306c32791 375 i2c.read(LSM303_ADR_ACC, &buf[i], 1);
lpeters 33:e47306c32791 376 }
lpeters 34:341fb423e74b 377 printf("CFGACC: | ");
lpeters 34:341fb423e74b 378 for (int i = 0; i < CFG_ACC_LEN; i++)
lpeters 34:341fb423e74b 379 {
lpeters 34:341fb423e74b 380 printf("%02X ", buf[i]);
lpeters 34:341fb423e74b 381 }
lpeters 34:341fb423e74b 382 printf("|\r\n");
lpeters 33:e47306c32791 383 }
lpeters 33:e47306c32791 384
lpeters 33:e47306c32791 385 void magDumpCfg()
lpeters 33:e47306c32791 386 {
lpeters 34:341fb423e74b 387 char start = CFG_MAG_ADR;
lpeters 34:341fb423e74b 388 for (int i = 0; i < CFG_MAG_LEN; i++)
lpeters 33:e47306c32791 389 {
lpeters 33:e47306c32791 390 cmd[0] = start + i;
lpeters 33:e47306c32791 391 i2c.write(LSM303_ADR_MAG, cmd, 1);
lpeters 33:e47306c32791 392 i2c.read(LSM303_ADR_MAG, &buf[i], 1);
lpeters 33:e47306c32791 393 }
lpeters 34:341fb423e74b 394 printf("CFGMAG: | ");
lpeters 34:341fb423e74b 395 for (int i = 0; i < CFG_MAG_LEN; i++)
lpeters 34:341fb423e74b 396 {
lpeters 34:341fb423e74b 397 printf("%02X ", buf[i]);
lpeters 34:341fb423e74b 398 }
lpeters 34:341fb423e74b 399 printf("|\r\n");
lpeters 33:e47306c32791 400 }
lpeters 33:e47306c32791 401
lpeters 37:df69df1bcb1a 402 // Clear any pending MAG IRQs
lpeters 37:df69df1bcb1a 403 inline void magWipeIrq() {
lpeters 37:df69df1bcb1a 404 cmd[0] = LSM303_REG_MAG_INT_SOURCE_REG_M;
lpeters 37:df69df1bcb1a 405 i2c.write(LSM303_ADR_MAG, cmd, 1);
lpeters 37:df69df1bcb1a 406 i2c.read(LSM303_ADR_MAG, &ret, 1);
lpeters 37:df69df1bcb1a 407 }
lpeters 37:df69df1bcb1a 408
mbed_official 0:7037ed05f54f 409 /**
mbed_official 0:7037ed05f54f 410 * Entry point for application
mbed_official 0:7037ed05f54f 411 */
mbed_official 0:7037ed05f54f 412 int main (void)
mbed_official 0:7037ed05f54f 413 {
lpeters 35:73b3963c6dd3 414 //i2c.frequency(400000);
lpeters 33:e47306c32791 415 wait(4);
lpeters 33:e47306c32791 416 printf("\r\n-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-\r\n");
lpeters 34:341fb423e74b 417
lpeters 34:341fb423e74b 418 // Boot Flash
lpeters 34:341fb423e74b 419 for (int i = 0; i <= 64; i++)
lpeters 33:e47306c32791 420 {
lpeters 34:341fb423e74b 421 myLedR = i & 0x01;
lpeters 34:341fb423e74b 422 myLedG = i & 0x02;
lpeters 34:341fb423e74b 423 myLedB = i & 0x04;
lpeters 34:341fb423e74b 424 myLedW = i & 0x08;
lpeters 34:341fb423e74b 425 wait(0.01);
lpeters 33:e47306c32791 426 }
lpeters 34:341fb423e74b 427 wait(4);
lpeters 35:73b3963c6dd3 428 // btnPin.rise(&onBtnIrq);
lpeters 37:df69df1bcb1a 429 printf("Boot flash complete.\r\n");
mbed_official 0:7037ed05f54f 430 // setup tracing
mbed_official 0:7037ed05f54f 431 setup_trace();
mbed_official 0:7037ed05f54f 432
lpeters 37:df69df1bcb1a 433 printf("Trace setup complete.\r\n");
lpeters 37:df69df1bcb1a 434
mbed_official 0:7037ed05f54f 435 // stores the status of a call to LoRaWAN protocol
mbed_official 0:7037ed05f54f 436 lorawan_status_t retcode;
lpeters 33:e47306c32791 437
lpeters 37:df69df1bcb1a 438 printf("Pre-sensor init.\r\n");
lpeters 37:df69df1bcb1a 439
lpeters 34:341fb423e74b 440 /* I2C init */
lpeters 34:341fb423e74b 441 ret = 0x00;
lpeters 34:341fb423e74b 442 magDumpCfg();
lpeters 34:341fb423e74b 443 accDumpCfg();
lpeters 34:341fb423e74b 444 magInitSequence();
lpeters 34:341fb423e74b 445 accInitSequence();
Huot87 38:fd7a407bfe3e 446
Huot87 38:fd7a407bfe3e 447 // HUOT Addition -- Reset GPS from previous tests
Huot87 38:fd7a407bfe3e 448 gpsExecuteCommand(cmdResetDefaults, sizeof(cmdResetDefaults));
Huot87 38:fd7a407bfe3e 449
lpeters 34:341fb423e74b 450 gpsInitSequence();
lpeters 33:e47306c32791 451 magDumpCfg();
lpeters 33:e47306c32791 452 accDumpCfg();
lpeters 37:df69df1bcb1a 453 printf("Post-sensor init.\r\n");
lpeters 33:e47306c32791 454
lpeters 34:341fb423e74b 455 cfg = 0x00;
lpeters 34:341fb423e74b 456 #if defined(TARGET_LRAT)
lpeters 33:e47306c32791 457 cmd[0] = LSM303_REG_ACC_CTRL_REG1_A;
lpeters 33:e47306c32791 458 i2c.write(LSM303_ADR_ACC, cmd, 1);
lpeters 33:e47306c32791 459 i2c.read(LSM303_ADR_ACC, &ret, 1);
lpeters 34:341fb423e74b 460 cfg |= (ret & 0x80) >> 7;
lpeters 33:e47306c32791 461 cmd[0] = LSM303_REG_ACC_CTRL_REG4_A;
lpeters 33:e47306c32791 462 i2c.write(LSM303_ADR_ACC, cmd, 1);
lpeters 33:e47306c32791 463 i2c.read(LSM303_ADR_ACC, &ret, 1);
lpeters 34:341fb423e74b 464 accScale = 1 << (!(ret & 0x30) ? 0 : ((ret & 0x30) >> 4) - 1);
lpeters 34:341fb423e74b 465 cmd[0] = LSM303_REG_MAG_CTRL_REG2_M;
lpeters 34:341fb423e74b 466 i2c.write(LSM303_ADR_MAG, cmd, 1);
lpeters 34:341fb423e74b 467 i2c.read(LSM303_ADR_MAG, &ret, 1);
lpeters 34:341fb423e74b 468 cfg |= (ret & 0x60) >> 1;
lpeters 34:341fb423e74b 469 //accShift = 0; // Full 16-bit resolution
lpeters 34:341fb423e74b 470 accShift = 4;
lpeters 34:341fb423e74b 471 #else
lpeters 33:e47306c32791 472 cmd[0] = LSM303_REG_ACC_CTRL_REG1_A;
lpeters 33:e47306c32791 473 i2c.write(LSM303_ADR_ACC, cmd, 1);
lpeters 33:e47306c32791 474 i2c.read(LSM303_ADR_ACC, &ret, 1);
lpeters 33:e47306c32791 475 cfg |= (ret & 0x08) >> 3;
lpeters 33:e47306c32791 476 cmd[0] = LSM303_REG_ACC_CTRL_REG4_A;
lpeters 33:e47306c32791 477 i2c.write(LSM303_ADR_ACC, cmd, 1);
lpeters 33:e47306c32791 478 i2c.read(LSM303_ADR_ACC, &ret, 1);
lpeters 33:e47306c32791 479 cfg |= (ret & 0x08) >> 2;
lpeters 33:e47306c32791 480 accScale = 1 << ((ret & 0x30) >> 4);
lpeters 33:e47306c32791 481 cmd[0] = LSM303_REG_MAG_CFG_REG_A_M;
lpeters 33:e47306c32791 482 i2c.write(LSM303_ADR_MAG, cmd, 1);
lpeters 33:e47306c32791 483 i2c.read(LSM303_ADR_MAG, &ret, 1);
lpeters 33:e47306c32791 484 cfg |= (ret & 0x10);
lpeters 33:e47306c32791 485 if (cfg & 0x01)
lpeters 33:e47306c32791 486 accShift = 8;
lpeters 33:e47306c32791 487 else if (cfg & 0x02)
lpeters 33:e47306c32791 488 accShift = 4;
lpeters 33:e47306c32791 489 else
lpeters 33:e47306c32791 490 accShift = 6;
lpeters 34:341fb423e74b 491 #endif
lpeters 33:e47306c32791 492 printf("Quality: %02x AccShift: %d AccScale: %d\r\n", cfg, accShift, accScale);
lpeters 33:e47306c32791 493
lpeters 35:73b3963c6dd3 494 time_t tNow;
lpeters 35:73b3963c6dd3 495 /*
lpeters 35:73b3963c6dd3 496 // while(1)
lpeters 35:73b3963c6dd3 497 // {
lpeters 35:73b3963c6dd3 498 tNow = time(NULL);
lpeters 35:73b3963c6dd3 499 printf("RTC: %08X\r\n", tNow);
lpeters 34:341fb423e74b 500 #if defined(SENSOR_TEMP)
lpeters 34:341fb423e74b 501 tmpRead();
lpeters 34:341fb423e74b 502 #endif
lpeters 34:341fb423e74b 503 magRead();
lpeters 34:341fb423e74b 504 accRead();
lpeters 34:341fb423e74b 505 gpsRead();
lpeters 35:73b3963c6dd3 506 printf("TIM: %d, SAT: %d, LAT: %f, LON: %f\r\n", mytime, mybatt, mylat, mylon);
lpeters 35:73b3963c6dd3 507 printf("IRQ: A=%02X M=%02X B=%02X\r\n", accHFire, magHFire, btnHFire);
lpeters 35:73b3963c6dd3 508 wait(1);
lpeters 35:73b3963c6dd3 509 // }
lpeters 35:73b3963c6dd3 510 */
lpeters 35:73b3963c6dd3 511
lpeters 35:73b3963c6dd3 512 for (int i = 0; i <= 64; i++)
lpeters 35:73b3963c6dd3 513 {
lpeters 35:73b3963c6dd3 514 myLedR = i & 0x01;
lpeters 35:73b3963c6dd3 515 myLedG = i & 0x02;
lpeters 35:73b3963c6dd3 516 myLedB = i & 0x04;
lpeters 35:73b3963c6dd3 517 myLedW = i & 0x08;
lpeters 35:73b3963c6dd3 518 wait(0.01);
lpeters 33:e47306c32791 519 }
lpeters 33:e47306c32791 520
Huot87 38:fd7a407bfe3e 521 // uint8_t crcA = 0;
Huot87 38:fd7a407bfe3e 522 // uint8_t crcB = 0;
Huot87 38:fd7a407bfe3e 523 // for(int i = 2; i <= 13; i++)
Huot87 38:fd7a407bfe3e 524 // {
Huot87 38:fd7a407bfe3e 525 // crcA = crcA + cmdStopGNSS[i];
Huot87 38:fd7a407bfe3e 526 // crcB = crcB + crcA;
Huot87 38:fd7a407bfe3e 527 // }
Huot87 38:fd7a407bfe3e 528 // cmdStopGNSS[14] = crcA;
Huot87 38:fd7a407bfe3e 529 // cmdStopGNSS[15] = crcB;
Huot87 38:fd7a407bfe3e 530 // printf("UBX CRC: %02X %02X\r\n", crcA, crcB);
Huot87 38:fd7a407bfe3e 531 // i2c.write(NEOM8M_ADR_GPS, cmdStopGNSS, 16);
Huot87 38:fd7a407bfe3e 532 // ubxRead();
Huot87 38:fd7a407bfe3e 533 // ubxRead();
Huot87 38:fd7a407bfe3e 534 // ubxRead();
Huot87 38:fd7a407bfe3e 535 // wait(1);
Huot87 38:fd7a407bfe3e 536 // ubxRead();
Huot87 38:fd7a407bfe3e 537 // return 0;
Huot87 38:fd7a407bfe3e 538
Huot87 38:fd7a407bfe3e 539 int x = 0;
Huot87 38:fd7a407bfe3e 540
Huot87 38:fd7a407bfe3e 541 printf("Putting to sleep... Good Luck ================ \r\n");
Huot87 38:fd7a407bfe3e 542 gpsExecuteCommand(secondTimeSleep, sizeof(secondTimeSleep));
Huot87 38:fd7a407bfe3e 543
Huot87 38:fd7a407bfe3e 544 // printf("Attempting to read GPS while down... \r\n");
Huot87 38:fd7a407bfe3e 545 // wait(1);
Huot87 38:fd7a407bfe3e 546 // gpsRead();
Huot87 38:fd7a407bfe3e 547 // printf("Entering GPS Sleep/Test Loop \r\n");
Huot87 38:fd7a407bfe3e 548
Huot87 38:fd7a407bfe3e 549 while(1)
lpeters 37:df69df1bcb1a 550 {
Huot87 38:fd7a407bfe3e 551 if ((x != 0) && (x % 10 == 0))
Huot87 38:fd7a407bfe3e 552 {
Huot87 38:fd7a407bfe3e 553 printf("Waking up GPS... Good luck, Huot \r\n");
Huot87 38:fd7a407bfe3e 554 gpsExecuteCommand(secondTimeAwake, sizeof(secondTimeAwake));
Huot87 38:fd7a407bfe3e 555
Huot87 38:fd7a407bfe3e 556 while (gpsRead() == 1);
Huot87 38:fd7a407bfe3e 557
Huot87 38:fd7a407bfe3e 558 printf("GPS Fix is good! Going to sleep... \r\n");
Huot87 38:fd7a407bfe3e 559 gpsExecuteCommand(secondTimeSleep, sizeof(secondTimeSleep));
Huot87 38:fd7a407bfe3e 560 }
Huot87 38:fd7a407bfe3e 561 printf("Waiting 5 seconds... \r\n");
Huot87 38:fd7a407bfe3e 562 wait(5);
Huot87 38:fd7a407bfe3e 563 x++;
Huot87 38:fd7a407bfe3e 564 printf("=== New loop incoming === \r\n");
lpeters 37:df69df1bcb1a 565 }
Huot87 38:fd7a407bfe3e 566
lpeters 37:df69df1bcb1a 567
lpeters 37:df69df1bcb1a 568
mbed_official 0:7037ed05f54f 569 // Initialize LoRaWAN stack
mbed_official 2:dc95ac6d6d4e 570 if (lorawan.initialize(&ev_queue) != LORAWAN_STATUS_OK) {
mbed_official 0:7037ed05f54f 571 printf("\r\n LoRa initialization failed! \r\n");
mbed_official 0:7037ed05f54f 572 return -1;
mbed_official 0:7037ed05f54f 573 }
mbed_official 0:7037ed05f54f 574
mbed_official 0:7037ed05f54f 575 printf("\r\n Mbed LoRaWANStack initialized \r\n");
lpeters 36:dcc6f89fa39a 576 printf("MBED_CONF_LORA_APP_PORT: %d\r\n", MBED_CONF_LORA_APP_PORT);
lpeters 36:dcc6f89fa39a 577 printf("MBED_CONF_LORA_DUTY_CYCLE_ON: %d\r\n", MBED_CONF_LORA_DUTY_CYCLE_ON);
mbed_official 0:7037ed05f54f 578
mbed_official 0:7037ed05f54f 579 // prepare application callbacks
mbed_official 0:7037ed05f54f 580 callbacks.events = mbed::callback(lora_event_handler);
mbed_official 2:dc95ac6d6d4e 581 lorawan.add_app_callbacks(&callbacks);
mbed_official 0:7037ed05f54f 582
mbed_official 0:7037ed05f54f 583 // Set number of retries in case of CONFIRMED messages
mbed_official 2:dc95ac6d6d4e 584 if (lorawan.set_confirmed_msg_retries(CONFIRMED_MSG_RETRY_COUNTER)
mbed_official 0:7037ed05f54f 585 != LORAWAN_STATUS_OK) {
mbed_official 0:7037ed05f54f 586 printf("\r\n set_confirmed_msg_retries failed! \r\n\r\n");
mbed_official 0:7037ed05f54f 587 return -1;
mbed_official 0:7037ed05f54f 588 }
mbed_official 0:7037ed05f54f 589
mbed_official 0:7037ed05f54f 590 printf("\r\n CONFIRMED message retries : %d \r\n",
mbed_official 0:7037ed05f54f 591 CONFIRMED_MSG_RETRY_COUNTER);
mbed_official 0:7037ed05f54f 592
mbed_official 0:7037ed05f54f 593 // Enable adaptive data rate
mbed_official 2:dc95ac6d6d4e 594 if (lorawan.enable_adaptive_datarate() != LORAWAN_STATUS_OK) {
mbed_official 0:7037ed05f54f 595 printf("\r\n enable_adaptive_datarate failed! \r\n");
mbed_official 0:7037ed05f54f 596 return -1;
mbed_official 0:7037ed05f54f 597 }
mbed_official 0:7037ed05f54f 598
mbed_official 0:7037ed05f54f 599 printf("\r\n Adaptive data rate (ADR) - Enabled \r\n");
mbed_official 0:7037ed05f54f 600
mbed_official 2:dc95ac6d6d4e 601 retcode = lorawan.connect();
lpeters 33:e47306c32791 602
mbed_official 0:7037ed05f54f 603 if (retcode == LORAWAN_STATUS_OK ||
mbed_official 0:7037ed05f54f 604 retcode == LORAWAN_STATUS_CONNECT_IN_PROGRESS) {
mbed_official 0:7037ed05f54f 605 } else {
mbed_official 0:7037ed05f54f 606 printf("\r\n Connection error, code = %d \r\n", retcode);
mbed_official 0:7037ed05f54f 607 return -1;
mbed_official 0:7037ed05f54f 608 }
mbed_official 0:7037ed05f54f 609
mbed_official 0:7037ed05f54f 610 printf("\r\n Connection - In Progress ...\r\n");
mbed_official 0:7037ed05f54f 611
mbed_official 0:7037ed05f54f 612 // make your event queue dispatching events forever
lpeters 36:dcc6f89fa39a 613 //ev_queue.dispatch_forever();
lpeters 36:dcc6f89fa39a 614 ev_queue.dispatch();
lpeters 36:dcc6f89fa39a 615 printf("\r\n- = - = - = - = - = - DISPATCH 1 COMPLETE - = - = - = - = - = -\r\n");
lpeters 36:dcc6f89fa39a 616 /*
lpeters 36:dcc6f89fa39a 617 printf("CONTROL LOOP GOES HERE!\r\n");
lpeters 36:dcc6f89fa39a 618 #if defined(TARGET_LRAT)
lpeters 36:dcc6f89fa39a 619 #else
lpeters 36:dcc6f89fa39a 620 for (int i = 0; i < 6; i++)
lpeters 36:dcc6f89fa39a 621 {
lpeters 36:dcc6f89fa39a 622 tNow = time(NULL);
lpeters 36:dcc6f89fa39a 623 printf("RTC: %08X\r\n", tNow);
lpeters 36:dcc6f89fa39a 624 tNext = tNow + 10;
lpeters 36:dcc6f89fa39a 625 printf("NXT: %08X\r\n", tNext);
lpeters 36:dcc6f89fa39a 626 // Clear any pending IRQs
lpeters 36:dcc6f89fa39a 627 cmd[0] = LSM303_REG_MAG_INT_SOURCE_REG_M;
lpeters 36:dcc6f89fa39a 628 i2c.write(LSM303_ADR_MAG, cmd, 1);
lpeters 36:dcc6f89fa39a 629 i2c.read(LSM303_ADR_MAG, &ret, 1);
lpeters 36:dcc6f89fa39a 630 while (time(NULL) < tNext)
lpeters 36:dcc6f89fa39a 631 {
lpeters 36:dcc6f89fa39a 632 wait(1);
lpeters 36:dcc6f89fa39a 633 }
lpeters 36:dcc6f89fa39a 634 printf("Timer #%d complete.\r\n", i);
lpeters 36:dcc6f89fa39a 635 }
lpeters 36:dcc6f89fa39a 636 #endif
lpeters 36:dcc6f89fa39a 637 */
lpeters 36:dcc6f89fa39a 638 tSend = time(NULL) + 1;
lpeters 36:dcc6f89fa39a 639 while (1) {
lpeters 36:dcc6f89fa39a 640 while (time(NULL) < tSend)
lpeters 36:dcc6f89fa39a 641 wait(0.1);
lpeters 37:df69df1bcb1a 642 if (tSend == 0)
lpeters 37:df69df1bcb1a 643 tCalm = time(NULL) + (DPANIC * NPANIC);
lpeters 37:df69df1bcb1a 644 tSend = time(NULL) + (time(NULL) < tCalm ? DPANIC : DCHILL);
lpeters 37:df69df1bcb1a 645 magWipeIrq();
lpeters 36:dcc6f89fa39a 646 printf("IT'S PACKET TIME!\r\n");
lpeters 36:dcc6f89fa39a 647 ev_queue.call(send_message);
lpeters 36:dcc6f89fa39a 648 ev_queue.dispatch();
lpeters 36:dcc6f89fa39a 649 printf("\r\n- = - = - = - = - = - DISPATCH 2 COMPLETE - = - = - = - = - = -\r\n");
lpeters 37:df69df1bcb1a 650 //tSend = time(NULL) + 300;
lpeters 37:df69df1bcb1a 651 //tSend = time(NULL) + (time(NULL) < tCalm ? DPANIC : DCHILL);
lpeters 36:dcc6f89fa39a 652 // Clear any pending IRQs
lpeters 37:df69df1bcb1a 653 // cmd[0] = LSM303_REG_MAG_INT_SOURCE_REG_M;
lpeters 37:df69df1bcb1a 654 // i2c.write(LSM303_ADR_MAG, cmd, 1);
lpeters 37:df69df1bcb1a 655 // i2c.read(LSM303_ADR_MAG, &ret, 1);
lpeters 36:dcc6f89fa39a 656 }
mbed_official 3:8c7198d1a2a1 657
mbed_official 3:8c7198d1a2a1 658 return 0;
mbed_official 0:7037ed05f54f 659 }
mbed_official 0:7037ed05f54f 660
mbed_official 0:7037ed05f54f 661 /**
mbed_official 0:7037ed05f54f 662 * Sends a message to the Network Server
mbed_official 0:7037ed05f54f 663 */
mbed_official 0:7037ed05f54f 664 static void send_message()
mbed_official 0:7037ed05f54f 665 {
lpeters 36:dcc6f89fa39a 666 printf("In send_message()...\r\n");
mbed_official 0:7037ed05f54f 667 uint16_t packet_len;
mbed_official 0:7037ed05f54f 668 int16_t retcode;
mbed_official 0:7037ed05f54f 669 float sensor_value;
mbed_official 0:7037ed05f54f 670
mbed_official 0:7037ed05f54f 671 if (ds1820.begin()) {
mbed_official 0:7037ed05f54f 672 ds1820.startConversion();
mbed_official 0:7037ed05f54f 673 sensor_value = ds1820.read();
mbed_official 0:7037ed05f54f 674 printf("\r\n Dummy Sensor Value = %3.1f \r\n", sensor_value);
mbed_official 0:7037ed05f54f 675 ds1820.startConversion();
mbed_official 0:7037ed05f54f 676 } else {
mbed_official 0:7037ed05f54f 677 printf("\r\n No sensor found \r\n");
mbed_official 0:7037ed05f54f 678 return;
mbed_official 0:7037ed05f54f 679 }
mbed_official 0:7037ed05f54f 680
tchari 30:ff249a9156dc 681 time_t tNow = time(NULL);
tchari 30:ff249a9156dc 682 printf("Clock: %d\r\n", tNow);
lpeters 34:341fb423e74b 683
lpeters 34:341fb423e74b 684 #if defined(SENSOR_TEMP)
lpeters 34:341fb423e74b 685 tmpRead();
lpeters 34:341fb423e74b 686 #endif
lpeters 34:341fb423e74b 687 magRead();
lpeters 34:341fb423e74b 688 accRead();
lpeters 34:341fb423e74b 689 gpsRead();
lpeters 34:341fb423e74b 690
lpeters 34:341fb423e74b 691 int ilat = (int)(mylat * 100000);
lpeters 34:341fb423e74b 692 int ilon = (int)(mylon * 100000);
lpeters 34:341fb423e74b 693 printf("TIM: %d, SAT: %d, LAT: %d, LON: %d\r\n", mytime, mybatt, ilat, ilon);
lpeters 34:341fb423e74b 694 packet_len = 11;
lpeters 34:341fb423e74b 695 tx_buffer[0] = (mytime >> 24) & 0xFF;
lpeters 34:341fb423e74b 696 tx_buffer[1] = (mytime >> 16) & 0xFF;
lpeters 34:341fb423e74b 697 tx_buffer[2] = (mytime >> 8) & 0xFF;
lpeters 34:341fb423e74b 698 tx_buffer[3] = (mytime >> 0) & 0xFF;
lpeters 34:341fb423e74b 699 tx_buffer[4] = ((mybatt << 4) & 0xF0) | ((ilat >> 22) & 0x0F);
lpeters 34:341fb423e74b 700 tx_buffer[5] = (ilat >> 14) & 0xFF;
lpeters 34:341fb423e74b 701 tx_buffer[6] = (ilat >> 6) & 0xFF;
lpeters 34:341fb423e74b 702 tx_buffer[7] = ((ilat << 2) & 0xFC) | ((ilon >> 24) & 0x03);
lpeters 34:341fb423e74b 703 tx_buffer[8] = (ilon >> 16) & 0xFF;
lpeters 34:341fb423e74b 704 tx_buffer[9] = (ilon >> 8) & 0xFF;
lpeters 34:341fb423e74b 705 tx_buffer[10] = (ilon >> 0) & 0xFF;
lpeters 34:341fb423e74b 706 printf("\r\nBUF: |");
lpeters 34:341fb423e74b 707 for (int i = 0; i < packet_len; i++) { printf("%02X", tx_buffer[i]); }
lpeters 34:341fb423e74b 708 printf("|\r\n");
lpeters 34:341fb423e74b 709 retcode = lorawan.send(MBED_CONF_LORA_APP_PORT, tx_buffer, packet_len,
lpeters 34:341fb423e74b 710 MSG_CONFIRMED_FLAG);
lpeters 33:e47306c32791 711
lpeters 34:341fb423e74b 712 if (retcode < 0) {
lpeters 34:341fb423e74b 713 retcode == LORAWAN_STATUS_WOULD_BLOCK ? printf("send - WOULD BLOCK\r\n")
lpeters 34:341fb423e74b 714 : printf("\r\n send() - Error code %d \r\n", retcode);
lpeters 34:341fb423e74b 715
lpeters 34:341fb423e74b 716 if (retcode == LORAWAN_STATUS_WOULD_BLOCK) {
lpeters 34:341fb423e74b 717 //retry in 3 seconds
lpeters 34:341fb423e74b 718 if (MBED_CONF_LORA_DUTY_CYCLE_ON) {
lpeters 34:341fb423e74b 719 ev_queue.call_in(3000, send_message);
lpeters 34:341fb423e74b 720 }
lpeters 34:341fb423e74b 721 }
lpeters 34:341fb423e74b 722 return;
lpeters 34:341fb423e74b 723 }
lpeters 34:341fb423e74b 724
lpeters 34:341fb423e74b 725 printf("\r\n %d bytes scheduled for transmission \r\n", retcode);
lpeters 34:341fb423e74b 726 memset(tx_buffer, 0, sizeof(tx_buffer));
lpeters 34:341fb423e74b 727
lpeters 34:341fb423e74b 728 //LED Confirmation Output - MESSAGE SENT
lpeters 34:341fb423e74b 729 for (int i = 0; i < 10; i++) {
lpeters 34:341fb423e74b 730 myLedG = 1;
lpeters 34:341fb423e74b 731 wait(0.1);
lpeters 34:341fb423e74b 732 myLedG = 0;
lpeters 34:341fb423e74b 733 myLedR = 1;
lpeters 34:341fb423e74b 734 wait(0.1);
lpeters 34:341fb423e74b 735 myLedR = 0;
lpeters 34:341fb423e74b 736 myLedB = 1;
lpeters 34:341fb423e74b 737 wait(0.1);
lpeters 34:341fb423e74b 738 myLedB = 0;
lpeters 34:341fb423e74b 739 }
lpeters 34:341fb423e74b 740 }
lpeters 34:341fb423e74b 741
lpeters 34:341fb423e74b 742 /**
lpeters 34:341fb423e74b 743 * Receive a message from the Network Server
lpeters 34:341fb423e74b 744 */
lpeters 34:341fb423e74b 745 static void receive_message()
lpeters 34:341fb423e74b 746 {
lpeters 36:dcc6f89fa39a 747 printf("In receive_message()...\r\n");
lpeters 34:341fb423e74b 748 int16_t retcode;
lpeters 34:341fb423e74b 749 retcode = lorawan.receive(MBED_CONF_LORA_APP_PORT, rx_buffer,
lpeters 34:341fb423e74b 750 sizeof(rx_buffer),
lpeters 34:341fb423e74b 751 MSG_CONFIRMED_FLAG|MSG_UNCONFIRMED_FLAG);
lpeters 34:341fb423e74b 752
lpeters 34:341fb423e74b 753 if (retcode < 0) {
lpeters 34:341fb423e74b 754 printf("\r\n receive() - Error code %d \r\n", retcode);
lpeters 34:341fb423e74b 755 return;
lpeters 34:341fb423e74b 756 }
lpeters 34:341fb423e74b 757
lpeters 34:341fb423e74b 758 printf(" Data:");
lpeters 34:341fb423e74b 759
lpeters 34:341fb423e74b 760 for (uint8_t i = 0; i < retcode; i++) {
lpeters 34:341fb423e74b 761 printf("%x", rx_buffer[i]);
lpeters 34:341fb423e74b 762 }
lpeters 34:341fb423e74b 763
lpeters 34:341fb423e74b 764 printf("\r\n Data Length: %d\r\n", retcode);
lpeters 34:341fb423e74b 765
lpeters 34:341fb423e74b 766 /*
lpeters 34:341fb423e74b 767 int startLoop = 0;
lpeters 34:341fb423e74b 768 if (strncmp((char *)rx_buffer, cmdSendLoop, 8) == 0)
lpeters 34:341fb423e74b 769 {
lpeters 34:341fb423e74b 770 printf("SendLoop Command Received!\r\n");
lpeters 34:341fb423e74b 771 startLoop = 1;
lpeters 34:341fb423e74b 772 }
lpeters 34:341fb423e74b 773 */
lpeters 34:341fb423e74b 774
lpeters 34:341fb423e74b 775 memset(rx_buffer, 0, sizeof(rx_buffer));
lpeters 34:341fb423e74b 776 /*
lpeters 34:341fb423e74b 777 if (startLoop)
lpeters 34:341fb423e74b 778 send_message();
lpeters 34:341fb423e74b 779 */
lpeters 34:341fb423e74b 780 }
lpeters 34:341fb423e74b 781
lpeters 34:341fb423e74b 782 /**
lpeters 34:341fb423e74b 783 * Event handler
lpeters 34:341fb423e74b 784 */
lpeters 34:341fb423e74b 785 static void lora_event_handler(lorawan_event_t event)
lpeters 34:341fb423e74b 786 {
lpeters 34:341fb423e74b 787 tr_debug("In lora_event_handler(%d)...", event);
lpeters 34:341fb423e74b 788 switch (event) {
lpeters 34:341fb423e74b 789 case CONNECTED:
lpeters 34:341fb423e74b 790 printf("\r\n Connection - Successful \r\n");
lpeters 36:dcc6f89fa39a 791 ev_queue.break_dispatch();
lpeters 36:dcc6f89fa39a 792 /*
lpeters 34:341fb423e74b 793 if (MBED_CONF_LORA_DUTY_CYCLE_ON) {
lpeters 34:341fb423e74b 794 send_message();
lpeters 34:341fb423e74b 795 } else {
lpeters 34:341fb423e74b 796 ev_queue.call_every(TX_TIMER, send_message);
lpeters 34:341fb423e74b 797 }
lpeters 36:dcc6f89fa39a 798 */
lpeters 34:341fb423e74b 799 break;
lpeters 34:341fb423e74b 800 case DISCONNECTED:
lpeters 34:341fb423e74b 801 ev_queue.break_dispatch();
lpeters 34:341fb423e74b 802 printf("\r\n Disconnected Successfully \r\n");
lpeters 34:341fb423e74b 803 break;
lpeters 34:341fb423e74b 804 case TX_DONE:
lpeters 34:341fb423e74b 805 printf("\r\n Message Sent to Network Server \r\n");
lpeters 36:dcc6f89fa39a 806 ev_queue.break_dispatch();
lpeters 36:dcc6f89fa39a 807 /*
lpeters 34:341fb423e74b 808 if (MBED_CONF_LORA_DUTY_CYCLE_ON) {
lpeters 34:341fb423e74b 809 send_message();
lpeters 34:341fb423e74b 810 }
lpeters 36:dcc6f89fa39a 811 */
lpeters 34:341fb423e74b 812 break;
lpeters 34:341fb423e74b 813 case TX_TIMEOUT:
lpeters 34:341fb423e74b 814 case TX_ERROR:
lpeters 34:341fb423e74b 815 case TX_CRYPTO_ERROR:
lpeters 34:341fb423e74b 816 case TX_SCHEDULING_ERROR:
lpeters 34:341fb423e74b 817 printf("\r\n Transmission Error - EventCode = %d \r\n", event);
lpeters 34:341fb423e74b 818 // try again
lpeters 36:dcc6f89fa39a 819 /*
lpeters 34:341fb423e74b 820 if (MBED_CONF_LORA_DUTY_CYCLE_ON) {
lpeters 34:341fb423e74b 821 send_message();
lpeters 34:341fb423e74b 822 }
lpeters 36:dcc6f89fa39a 823 */
lpeters 34:341fb423e74b 824 break;
lpeters 34:341fb423e74b 825 case RX_DONE:
lpeters 34:341fb423e74b 826 printf("\r\n Received message from Network Server \r\n");
lpeters 34:341fb423e74b 827 receive_message();
lpeters 34:341fb423e74b 828 break;
lpeters 34:341fb423e74b 829 case RX_TIMEOUT:
lpeters 34:341fb423e74b 830 case RX_ERROR:
lpeters 34:341fb423e74b 831 printf("\r\n Error in reception - Code = %d \r\n", event);
lpeters 34:341fb423e74b 832 break;
lpeters 34:341fb423e74b 833 case JOIN_FAILURE:
lpeters 34:341fb423e74b 834 printf("\r\n OTAA Failed - Check Keys \r\n");
lpeters 34:341fb423e74b 835 break;
lpeters 34:341fb423e74b 836 case UPLINK_REQUIRED:
lpeters 34:341fb423e74b 837 printf("\r\n Uplink required by NS \r\n");
lpeters 36:dcc6f89fa39a 838 /*
lpeters 34:341fb423e74b 839 if (MBED_CONF_LORA_DUTY_CYCLE_ON) {
lpeters 34:341fb423e74b 840 send_message();
lpeters 34:341fb423e74b 841 }
lpeters 36:dcc6f89fa39a 842 */
lpeters 34:341fb423e74b 843 break;
lpeters 34:341fb423e74b 844 default:
lpeters 34:341fb423e74b 845 MBED_ASSERT("Unknown Event");
lpeters 34:341fb423e74b 846 }
lpeters 34:341fb423e74b 847 }
lpeters 34:341fb423e74b 848
lpeters 34:341fb423e74b 849 void magInitSequence()
lpeters 34:341fb423e74b 850 {
lpeters 35:73b3963c6dd3 851 printf("In magInitSequence()...\r\n");
lpeters 34:341fb423e74b 852 myLedR = 0;
lpeters 34:341fb423e74b 853 myLedG = 0;
lpeters 34:341fb423e74b 854 cmd[0] = LSM303_REG_MAG_WHO_AM_I_M;
lpeters 34:341fb423e74b 855 i2c.write(LSM303_ADR_MAG, cmd, 1);
lpeters 34:341fb423e74b 856 i2c.read(LSM303_ADR_MAG, &ret, 1);
lpeters 34:341fb423e74b 857 res = (ret == LSM303_WHO_MAG ? sPass : sFail);
lpeters 34:341fb423e74b 858 printf("MAG WhoAmI: %02X %s\r\n", ret, res);
lpeters 34:341fb423e74b 859
lpeters 34:341fb423e74b 860 if (ret == LSM303_WHO_MAG)
lpeters 34:341fb423e74b 861 myLedG = 1;
lpeters 34:341fb423e74b 862 else
lpeters 34:341fb423e74b 863 myLedR = 1;
lpeters 34:341fb423e74b 864
lpeters 34:341fb423e74b 865 for (int i = 0; i < 2; i++) {
lpeters 34:341fb423e74b 866 myLedB = 1;
lpeters 34:341fb423e74b 867 wait(0.3);
lpeters 34:341fb423e74b 868 myLedB = 0;
lpeters 34:341fb423e74b 869 wait(0.3);
lpeters 34:341fb423e74b 870 }
lpeters 34:341fb423e74b 871
lpeters 34:341fb423e74b 872 #if defined(TARGET_LRAT)
lpeters 34:341fb423e74b 873 cmd[0] = LSM303_REG_MAG_CTRL_REG1_M;
lpeters 34:341fb423e74b 874 cmd[1] = 0x70; // Ultra-High Performance Mode on XY axes, ODR=10Hz
lpeters 34:341fb423e74b 875 i2c.write(LSM303_ADR_MAG, cmd, 2);
lpeters 34:341fb423e74b 876 cmd[0] = LSM303_REG_MAG_CTRL_REG3_M;
lpeters 34:341fb423e74b 877 cmd[1] = 0x00; // High Resolution? (Full-power), Continuous
lpeters 34:341fb423e74b 878 i2c.write(LSM303_ADR_MAG, cmd, 2);
lpeters 34:341fb423e74b 879 cmd[0] = LSM303_REG_MAG_CTRL_REG4_M;
lpeters 34:341fb423e74b 880 cmd[1] = 0x0C; // Ultra-High Performance Mode on Z axis
lpeters 34:341fb423e74b 881 i2c.write(LSM303_ADR_MAG, cmd, 2);
lpeters 34:341fb423e74b 882 #if defined(SENSOR_TEMP)
lpeters 34:341fb423e74b 883 // Enable Temp Sensor
lpeters 34:341fb423e74b 884 cmd[0] = LSM303_REG_MAG_CTRL_REG1_M;
lpeters 34:341fb423e74b 885 i2c.write(LSM303_ADR_MAG, cmd, 1);
lpeters 34:341fb423e74b 886 i2c.read(LSM303_ADR_MAG, &ret, 1);
lpeters 34:341fb423e74b 887 cmd[0] = LSM303_REG_MAG_CTRL_REG1_M;
lpeters 34:341fb423e74b 888 cmd[1] = ret | 0x80;
lpeters 34:341fb423e74b 889 i2c.write(LSM303_ADR_MAG, cmd, 2);
lpeters 34:341fb423e74b 890 /*
lpeters 34:341fb423e74b 891 cmd[0] = LSM303_REG_MAG_CTRL_REG5_M;
lpeters 34:341fb423e74b 892 i2c.write(LSM303_ADR_MAG, cmd, 1);
lpeters 34:341fb423e74b 893 i2c.read(LSM303_ADR_MAG, &ret, 1);
lpeters 34:341fb423e74b 894 cmd[0] = LSM303_REG_MAG_CTRL_REG5_M;
lpeters 34:341fb423e74b 895 cmd[1] = ret | 0x40;
lpeters 34:341fb423e74b 896 i2c.write(LSM303_ADR_MAG, cmd, 2);
lpeters 34:341fb423e74b 897 */
lpeters 34:341fb423e74b 898 #endif
lpeters 34:341fb423e74b 899 #else
lpeters 34:341fb423e74b 900 cmd[0] = LSM303_REG_MAG_CFG_REG_A_M;
lpeters 34:341fb423e74b 901 cmd[1] = 0x00; // Mag = 10 Hz (high-resolution and continuous mode)
lpeters 34:341fb423e74b 902 i2c.write(LSM303_ADR_MAG, cmd, 2);
lpeters 34:341fb423e74b 903 cmd[0] = LSM303_REG_MAG_CFG_REG_C_M;
lpeters 34:341fb423e74b 904 //cmd[1] = 0x01; // Mag data-ready interrupt enable
lpeters 34:341fb423e74b 905 cmd[1] = 0x40; // Mag enable interrupt on pin
lpeters 34:341fb423e74b 906 i2c.write(LSM303_ADR_MAG, cmd, 2);
lpeters 34:341fb423e74b 907 #endif
lpeters 34:341fb423e74b 908
lpeters 34:341fb423e74b 909 for (int i = 0; i < 2; i++) {
lpeters 34:341fb423e74b 910 myLedR = 1;
lpeters 34:341fb423e74b 911 myLedG = 1;
lpeters 34:341fb423e74b 912 myLedB = 1;
lpeters 34:341fb423e74b 913 wait(0.5);
lpeters 34:341fb423e74b 914 myLedR = 0;
lpeters 34:341fb423e74b 915 myLedG = 0;
lpeters 34:341fb423e74b 916 myLedB = 0;
lpeters 34:341fb423e74b 917 wait(0.5);
lpeters 34:341fb423e74b 918 }
lpeters 35:73b3963c6dd3 919 #if defined(TARGET_LRAT)
lpeters 35:73b3963c6dd3 920 // LRAT MAG IRQ SETUP GOES HERE
lpeters 35:73b3963c6dd3 921 #else
lpeters 34:341fb423e74b 922 // MAG INTERRUPT SETUP
lpeters 34:341fb423e74b 923 cmd[0] = LSM303_REG_MAG_INT_THS_L_REG_M;
lpeters 35:73b3963c6dd3 924 cmd[1] = 0xE8;
lpeters 34:341fb423e74b 925 i2c.write(LSM303_ADR_MAG, cmd, 2);
lpeters 34:341fb423e74b 926 cmd[0] = LSM303_REG_MAG_INT_THS_H_REG_M;
lpeters 35:73b3963c6dd3 927 cmd[1] = 0x03;
lpeters 34:341fb423e74b 928 i2c.write(LSM303_ADR_MAG, cmd, 2);
lpeters 34:341fb423e74b 929 cmd[0] = LSM303_REG_MAG_INT_CTRL_REG_M;
lpeters 34:341fb423e74b 930 cmd[1] = 0xE7;
lpeters 34:341fb423e74b 931 i2c.write(LSM303_ADR_MAG, cmd, 2);
lpeters 34:341fb423e74b 932 magPin.rise(&onMagIrq);
lpeters 35:73b3963c6dd3 933 #endif
lpeters 34:341fb423e74b 934 }
lpeters 34:341fb423e74b 935
lpeters 34:341fb423e74b 936 void accInitSequence()
lpeters 34:341fb423e74b 937 {
lpeters 35:73b3963c6dd3 938 printf("In accInitSequence()...\r\n");
lpeters 34:341fb423e74b 939 myLedR = 0;
lpeters 34:341fb423e74b 940 myLedG = 0;
lpeters 34:341fb423e74b 941 cmd[0] = LSM303_REG_ACC_WHO_AM_I_A;
lpeters 34:341fb423e74b 942 i2c.write(LSM303_ADR_ACC, cmd, 1);
lpeters 34:341fb423e74b 943 i2c.read(LSM303_ADR_ACC, &ret, 1);
lpeters 34:341fb423e74b 944 res = (ret == LSM303_WHO_ACC ? sPass : sFail);
lpeters 34:341fb423e74b 945 printf("ACC WhoAmI: %02X %s\r\n", ret, res);
lpeters 34:341fb423e74b 946
lpeters 34:341fb423e74b 947 if (ret == LSM303_WHO_ACC)
lpeters 34:341fb423e74b 948 myLedG = 1;
lpeters 34:341fb423e74b 949 else
lpeters 34:341fb423e74b 950 myLedR = 1;
lpeters 34:341fb423e74b 951
lpeters 34:341fb423e74b 952 for (int i = 0; i < 2; i++) {
lpeters 34:341fb423e74b 953 myLedB = 1;
lpeters 34:341fb423e74b 954 wait(0.3);
lpeters 34:341fb423e74b 955 myLedB = 0;
lpeters 34:341fb423e74b 956 wait(0.3);
lpeters 34:341fb423e74b 957 }
lpeters 34:341fb423e74b 958
lpeters 34:341fb423e74b 959 #if defined(TARGET_LRAT)
lpeters 34:341fb423e74b 960 cmd[0] = LSM303_REG_ACC_CTRL_REG1_A;
lpeters 34:341fb423e74b 961 cmd[1] = 0xB7; // High Resolution, ODR=100Hz, Enable XYZ Axes
lpeters 34:341fb423e74b 962 i2c.write(LSM303_ADR_ACC, cmd, 2);
lpeters 34:341fb423e74b 963 #else
lpeters 34:341fb423e74b 964 cmd[0] = LSM303_REG_ACC_CTRL_REG1_A;
lpeters 34:341fb423e74b 965 cmd[1] = 0x57; // Enable XYZ Axes, ODR=100Hz
lpeters 34:341fb423e74b 966 i2c.write(LSM303_ADR_ACC, cmd, 2);
lpeters 34:341fb423e74b 967
lpeters 34:341fb423e74b 968 // Enable High Resolution Mode
lpeters 34:341fb423e74b 969 cmd[0] = LSM303_REG_ACC_CTRL_REG4_A;
lpeters 34:341fb423e74b 970 i2c.write(LSM303_ADR_ACC, cmd, 1);
lpeters 34:341fb423e74b 971 i2c.read(LSM303_ADR_ACC, &ret, 1);
lpeters 34:341fb423e74b 972 cmd[0] = LSM303_REG_ACC_CTRL_REG4_A;
lpeters 34:341fb423e74b 973 cmd[1] = ret | 0x08; // High Resolution
lpeters 34:341fb423e74b 974 i2c.write(LSM303_ADR_ACC, cmd, 2);
lpeters 34:341fb423e74b 975
lpeters 34:341fb423e74b 976 #if defined(SENSOR_TEMP)
lpeters 34:341fb423e74b 977 // Enable Temp Sensor
lpeters 34:341fb423e74b 978 cmd[0] = LSM303_REG_ACC_TEMP_CFG_REG_A;
lpeters 34:341fb423e74b 979 cmd[1] = 0xC0;
lpeters 34:341fb423e74b 980 i2c.write(LSM303_ADR_ACC, cmd, 2);
lpeters 34:341fb423e74b 981 cmd[0] = LSM303_REG_ACC_CTRL_REG4_A;
lpeters 34:341fb423e74b 982 i2c.write(LSM303_ADR_ACC, cmd, 1);
lpeters 34:341fb423e74b 983 i2c.read(LSM303_ADR_ACC, &ret, 1);
lpeters 34:341fb423e74b 984 cmd[0] = LSM303_REG_ACC_CTRL_REG4_A;
lpeters 34:341fb423e74b 985 cmd[1] = ret | 0x80;
lpeters 34:341fb423e74b 986 i2c.write(LSM303_ADR_ACC, cmd, 2);
lpeters 34:341fb423e74b 987 #endif
lpeters 34:341fb423e74b 988 #endif
lpeters 34:341fb423e74b 989
lpeters 34:341fb423e74b 990 //LED Confirmation Output - ACC INIT COMPLETE
lpeters 34:341fb423e74b 991 for (int i = 0; i < 2; i++) {
lpeters 34:341fb423e74b 992 myLedR = 1;
lpeters 34:341fb423e74b 993 myLedG = 1;
lpeters 34:341fb423e74b 994 myLedB = 1;
lpeters 34:341fb423e74b 995 wait(0.5);
lpeters 34:341fb423e74b 996 myLedR = 0;
lpeters 34:341fb423e74b 997 myLedG = 0;
lpeters 34:341fb423e74b 998 myLedB = 0;
lpeters 34:341fb423e74b 999 wait(0.5);
lpeters 34:341fb423e74b 1000 }
lpeters 34:341fb423e74b 1001
lpeters 34:341fb423e74b 1002 // Set Full Scale to 4g
lpeters 34:341fb423e74b 1003 /*
lpeters 34:341fb423e74b 1004 cmd[0] = LSM303_REG_ACC_CTRL_REG4_A;
lpeters 34:341fb423e74b 1005 i2c.write(LSM303_ADR_ACC, cmd, 1);
lpeters 34:341fb423e74b 1006 i2c.read(LSM303_ADR_ACC, &ret, 1);
lpeters 34:341fb423e74b 1007 cmd[0] = LSM303_REG_ACC_CTRL_REG4_A;
lpeters 34:341fb423e74b 1008 //cmd[1] = ret | 0x30; // 16g
lpeters 34:341fb423e74b 1009 //cmd[1] = (ret & ~0x10) | 0x20; // 8g
lpeters 34:341fb423e74b 1010 cmd[1] = (ret & ~0x20) | 0x10; // 4g
lpeters 34:341fb423e74b 1011 //cmd[1] = ret & ~0x30; // 2g
lpeters 34:341fb423e74b 1012 i2c.write(LSM303_ADR_ACC, cmd, 2);
lpeters 34:341fb423e74b 1013 */
lpeters 34:341fb423e74b 1014 /*
lpeters 34:341fb423e74b 1015 // IRQ Init from Datasheet.
lpeters 34:341fb423e74b 1016 cmd[0] = LSM303_REG_ACC_CTRL_REG1_A;
lpeters 34:341fb423e74b 1017 cmd[1] = 0xA7;
lpeters 34:341fb423e74b 1018 i2c.write(LSM303_ADR_ACC, cmd, 2);
lpeters 34:341fb423e74b 1019 cmd[0] = LSM303_REG_ACC_CTRL_REG2_A;
lpeters 34:341fb423e74b 1020 cmd[1] = 0x00;
lpeters 34:341fb423e74b 1021 i2c.write(LSM303_ADR_ACC, cmd, 2);
lpeters 34:341fb423e74b 1022 cmd[0] = LSM303_REG_ACC_CTRL_REG3_A;
lpeters 34:341fb423e74b 1023 cmd[1] = 0x40;
lpeters 34:341fb423e74b 1024 i2c.write(LSM303_ADR_ACC, cmd, 2);
lpeters 34:341fb423e74b 1025 cmd[0] = LSM303_REG_ACC_CTRL_REG4_A;
lpeters 34:341fb423e74b 1026 cmd[1] = 0x00;
lpeters 34:341fb423e74b 1027 //cmd[1] = 0x10;
lpeters 34:341fb423e74b 1028 i2c.write(LSM303_ADR_ACC, cmd, 2);
lpeters 34:341fb423e74b 1029 cmd[0] = LSM303_REG_ACC_CTRL_REG5_A;
lpeters 34:341fb423e74b 1030 cmd[1] = 0x08;
lpeters 34:341fb423e74b 1031 i2c.write(LSM303_ADR_ACC, cmd, 2);
lpeters 34:341fb423e74b 1032 */
lpeters 35:73b3963c6dd3 1033 #if defined(TARGET_LRAT)
lpeters 35:73b3963c6dd3 1034 // LRAT ACC IRQ SETUP GOES HERE
lpeters 35:73b3963c6dd3 1035 #else
lpeters 34:341fb423e74b 1036 // ACC INTERRUPT SETUP
lpeters 34:341fb423e74b 1037 // Enable Interrupt Pin
lpeters 34:341fb423e74b 1038 cmd[0] = LSM303_REG_ACC_CTRL_REG3_A;
lpeters 34:341fb423e74b 1039 i2c.write(LSM303_ADR_ACC, cmd, 1);
lpeters 34:341fb423e74b 1040 i2c.read(LSM303_ADR_ACC, &ret, 1);
lpeters 34:341fb423e74b 1041 cmd[0] = LSM303_REG_ACC_CTRL_REG3_A;
lpeters 34:341fb423e74b 1042 cmd[1] = ret | 0x40;
lpeters 34:341fb423e74b 1043 i2c.write(LSM303_ADR_ACC, cmd, 2);
lpeters 34:341fb423e74b 1044 // Enable Interrupt Latch
lpeters 34:341fb423e74b 1045 cmd[0] = LSM303_REG_ACC_CTRL_REG5_A;
lpeters 34:341fb423e74b 1046 i2c.write(LSM303_ADR_ACC, cmd, 1);
lpeters 34:341fb423e74b 1047 i2c.read(LSM303_ADR_ACC, &ret, 1);
lpeters 34:341fb423e74b 1048 cmd[0] = LSM303_REG_ACC_CTRL_REG5_A;
lpeters 34:341fb423e74b 1049 cmd[1] = ret | 0x08;
lpeters 34:341fb423e74b 1050 i2c.write(LSM303_ADR_ACC, cmd, 2);
lpeters 34:341fb423e74b 1051
lpeters 34:341fb423e74b 1052 // Set Threshold/Duration/Config
lpeters 34:341fb423e74b 1053 cmd[0] = LSM303_REG_ACC_INT1_THS_A;
lpeters 34:341fb423e74b 1054 //cmd[1] = 0x10;
lpeters 34:341fb423e74b 1055 //cmd[1] = 0x40;
lpeters 34:341fb423e74b 1056 //cmd[1] = 0x60;
lpeters 34:341fb423e74b 1057 cmd[1] = 0x7D;
lpeters 34:341fb423e74b 1058 i2c.write(LSM303_ADR_ACC, cmd, 2);
lpeters 34:341fb423e74b 1059 cmd[0] = LSM303_REG_ACC_INT1_DURATION_A;
lpeters 34:341fb423e74b 1060 cmd[1] = 0x00;
lpeters 34:341fb423e74b 1061 i2c.write(LSM303_ADR_ACC, cmd, 2);
lpeters 34:341fb423e74b 1062 cmd[0] = LSM303_REG_ACC_INT1_CFG_A;
lpeters 34:341fb423e74b 1063 cmd[1] = 0x2A;
lpeters 34:341fb423e74b 1064 //cmd[1] = 0x0A;
lpeters 34:341fb423e74b 1065 i2c.write(LSM303_ADR_ACC, cmd, 2);
lpeters 35:73b3963c6dd3 1066 accPin.rise(&onAccIrq);
lpeters 35:73b3963c6dd3 1067 #endif
lpeters 34:341fb423e74b 1068 }
lpeters 34:341fb423e74b 1069
lpeters 34:341fb423e74b 1070 void gpsInitSequence()
lpeters 34:341fb423e74b 1071 {
lpeters 35:73b3963c6dd3 1072 printf("In gpsInitSequence()...\r\n");
lpeters 35:73b3963c6dd3 1073 gpsRead();
lpeters 35:73b3963c6dd3 1074 if (mytime > 0)
lpeters 35:73b3963c6dd3 1075 {
lpeters 35:73b3963c6dd3 1076 set_time(mytime);
lpeters 35:73b3963c6dd3 1077 tInit = mytime;
lpeters 35:73b3963c6dd3 1078 myLedG = 1;
lpeters 35:73b3963c6dd3 1079 }
lpeters 35:73b3963c6dd3 1080 else
lpeters 35:73b3963c6dd3 1081 myLedR = 1;
lpeters 34:341fb423e74b 1082
lpeters 34:341fb423e74b 1083 for (int i = 0; i < 2; i++) {
lpeters 34:341fb423e74b 1084 myLedB = 1;
lpeters 34:341fb423e74b 1085 wait(0.3);
lpeters 34:341fb423e74b 1086 myLedB = 0;
lpeters 34:341fb423e74b 1087 wait(0.3);
lpeters 34:341fb423e74b 1088 }
lpeters 34:341fb423e74b 1089 myLedG = 0;
lpeters 34:341fb423e74b 1090 myLedR = 0;
Huot87 38:fd7a407bfe3e 1091
Huot87 38:fd7a407bfe3e 1092 // HUOT ADDITION -- GPS LOW POWER SETUP
Huot87 38:fd7a407bfe3e 1093 //printf("Disabling GLONASS... \r\n");
Huot87 38:fd7a407bfe3e 1094 //gpsExecuteCommand(cmdDisableGLONASS, sizeof(cmdDisableGLONASS)); // Disable GLONASS
Huot87 38:fd7a407bfe3e 1095 //printf("Disabling Time Pulse... \r\n");
Huot87 38:fd7a407bfe3e 1096 //gpsExecuteCommand(cmdDisableTimePulse, sizeof(cmdDisableTimePulse)); // Disable Time Pulse
Huot87 38:fd7a407bfe3e 1097 //printf("Configuring PMS... \r\n");
Huot87 38:fd7a407bfe3e 1098 //gpsExecuteCommand(cmdConfigPMS, sizeof(cmdConfigPMS)); // Configure Power Management Setup
Huot87 38:fd7a407bfe3e 1099 //printf("LPM Init Sequence Complete. \r\n");
Huot87 38:fd7a407bfe3e 1100 }
Huot87 38:fd7a407bfe3e 1101
Huot87 38:fd7a407bfe3e 1102 // HUOT Addition 08/30/2018 -- Generic GPS Execute command function
Huot87 38:fd7a407bfe3e 1103 void gpsExecuteCommand(char *command, int length)
Huot87 38:fd7a407bfe3e 1104 {
Huot87 38:fd7a407bfe3e 1105
Huot87 38:fd7a407bfe3e 1106 uint8_t crcA = 0;
Huot87 38:fd7a407bfe3e 1107 uint8_t crcB = 0;
Huot87 38:fd7a407bfe3e 1108 for(int i = 2; i <= (length - 3); i++)
Huot87 38:fd7a407bfe3e 1109 {
Huot87 38:fd7a407bfe3e 1110 crcA = crcA + command[i];
Huot87 38:fd7a407bfe3e 1111 crcB = crcB + crcA;
Huot87 38:fd7a407bfe3e 1112 }
Huot87 38:fd7a407bfe3e 1113
Huot87 38:fd7a407bfe3e 1114 command[(length - 2)] = crcA;
Huot87 38:fd7a407bfe3e 1115 command[(length - 1)] = crcB;
Huot87 38:fd7a407bfe3e 1116 printf("UBX CRC: %02X %02X\r\n", crcA, crcB);
Huot87 38:fd7a407bfe3e 1117 i2c.write(NEOM8M_ADR_GPS, command, length);
Huot87 38:fd7a407bfe3e 1118 printf("Command Executed \r\n");
Huot87 38:fd7a407bfe3e 1119 wait(1);
lpeters 34:341fb423e74b 1120 }
lpeters 34:341fb423e74b 1121
lpeters 34:341fb423e74b 1122 void magRead()
lpeters 34:341fb423e74b 1123 {
lpeters 34:341fb423e74b 1124 cmd[0] = LSM303_REG_MAG_STATUS_REG_M;
lpeters 34:341fb423e74b 1125 i2c.write(LSM303_ADR_MAG, cmd, 1);
lpeters 34:341fb423e74b 1126 i2c.read(LSM303_ADR_MAG, &rda, 1);
lpeters 34:341fb423e74b 1127 if (rda)
lpeters 34:341fb423e74b 1128 {
lpeters 34:341fb423e74b 1129 cmd[0] = LSM303_REG_MAG_OUTX_L_REG_M;
lpeters 34:341fb423e74b 1130 i2c.write(LSM303_ADR_MAG, cmd, 1);
lpeters 34:341fb423e74b 1131 i2c.read(LSM303_ADR_MAG, &buf[0], 1);
lpeters 34:341fb423e74b 1132 cmd[0] = LSM303_REG_MAG_OUTX_H_REG_M;
lpeters 34:341fb423e74b 1133 i2c.write(LSM303_ADR_MAG, cmd, 1);
lpeters 34:341fb423e74b 1134 i2c.read(LSM303_ADR_MAG, &buf[1], 1);
lpeters 34:341fb423e74b 1135 cmd[0] = LSM303_REG_MAG_OUTY_L_REG_M;
lpeters 34:341fb423e74b 1136 i2c.write(LSM303_ADR_MAG, cmd, 1);
lpeters 34:341fb423e74b 1137 i2c.read(LSM303_ADR_MAG, &buf[2], 1);
lpeters 34:341fb423e74b 1138 cmd[0] = LSM303_REG_MAG_OUTY_H_REG_M;
lpeters 34:341fb423e74b 1139 i2c.write(LSM303_ADR_MAG, cmd, 1);
lpeters 34:341fb423e74b 1140 i2c.read(LSM303_ADR_MAG, &buf[3], 1);
lpeters 34:341fb423e74b 1141 cmd[0] = LSM303_REG_MAG_OUTZ_L_REG_M;
lpeters 34:341fb423e74b 1142 i2c.write(LSM303_ADR_MAG, cmd, 1);
lpeters 34:341fb423e74b 1143 i2c.read(LSM303_ADR_MAG, &buf[4], 1);
lpeters 34:341fb423e74b 1144 cmd[0] = LSM303_REG_MAG_OUTZ_H_REG_M;
lpeters 34:341fb423e74b 1145 i2c.write(LSM303_ADR_MAG, cmd, 1);
lpeters 34:341fb423e74b 1146 i2c.read(LSM303_ADR_MAG, &buf[5], 1);
lpeters 34:341fb423e74b 1147 myMagX = (buf[0] | (buf[1] << 8));
lpeters 34:341fb423e74b 1148 myMagY = (buf[2] | (buf[3] << 8));
lpeters 34:341fb423e74b 1149 myMagZ = (buf[4] | (buf[5] << 8));
lpeters 34:341fb423e74b 1150 if (myMagX < magMinX)
lpeters 34:341fb423e74b 1151 magMinX = myMagX;
lpeters 34:341fb423e74b 1152 if (myMagY < magMinY)
lpeters 34:341fb423e74b 1153 magMinY = myMagY;
lpeters 34:341fb423e74b 1154 if (myMagZ < magMinZ)
lpeters 34:341fb423e74b 1155 magMinZ = myMagZ;
lpeters 34:341fb423e74b 1156 if (myMagX > magMaxX)
lpeters 34:341fb423e74b 1157 magMaxX = myMagX;
lpeters 34:341fb423e74b 1158 if (myMagY > magMaxY)
lpeters 34:341fb423e74b 1159 magMaxY = myMagY;
lpeters 34:341fb423e74b 1160 if (myMagZ > magMaxZ)
lpeters 34:341fb423e74b 1161 magMaxZ = myMagZ;
lpeters 34:341fb423e74b 1162 cmd[0] = LSM303_REG_MAG_INT_SOURCE_REG_M;
lpeters 34:341fb423e74b 1163 i2c.write(LSM303_ADR_MAG, cmd, 1);
lpeters 34:341fb423e74b 1164 i2c.read(LSM303_ADR_MAG, &ret, 1);
lpeters 34:341fb423e74b 1165 if (ret & 0x01 && magEvent == 0 && ret & 0xFC)
lpeters 34:341fb423e74b 1166 {
lpeters 34:341fb423e74b 1167 magSFire++;
lpeters 34:341fb423e74b 1168 magEvent = 1;
lpeters 34:341fb423e74b 1169 magSHIRQ++;
lpeters 34:341fb423e74b 1170 }
lpeters 34:341fb423e74b 1171 else if (!(ret & 0x01) && magEvent == 1 && !(ret & 0xFC))
lpeters 34:341fb423e74b 1172 {
lpeters 34:341fb423e74b 1173 magSFire++;
lpeters 34:341fb423e74b 1174 magEvent = 0;
lpeters 34:341fb423e74b 1175 magSLIRQ++;
lpeters 34:341fb423e74b 1176 }
lpeters 34:341fb423e74b 1177 printf("M|%02X|%02X %02X %02X %02X %02X %02X|%*d,%*d,%*d|%*d,%*d,%*d|%*d,%*d,%*d|%02X|%02X/%02X %02X/%02X\r\n", rda, buf[0], buf[1], buf[2], buf[3], buf[4], buf[5], 6, myMagX, 6, myMagY, 6, myMagZ, 6, magMinX, 6, magMinY, 6, magMinZ, 6, magMaxX, 6, magMaxY, 6, magMaxZ, ret, magSHIRQ, magSLIRQ, magSFire, magHFire);
lpeters 34:341fb423e74b 1178 }
lpeters 34:341fb423e74b 1179 }
lpeters 34:341fb423e74b 1180
lpeters 34:341fb423e74b 1181 void accRead()
lpeters 34:341fb423e74b 1182 {
lpeters 34:341fb423e74b 1183 cmd[0] = LSM303_REG_ACC_STATUS_REG_A;
lpeters 34:341fb423e74b 1184 i2c.write(LSM303_ADR_ACC, cmd, 1);
lpeters 34:341fb423e74b 1185 i2c.read(LSM303_ADR_ACC, &rda, 1);
lpeters 34:341fb423e74b 1186 if (rda)
lpeters 34:341fb423e74b 1187 {
lpeters 34:341fb423e74b 1188 cmd[0] = LSM303_REG_ACC_OUT_X_L_A;
lpeters 34:341fb423e74b 1189 i2c.write(LSM303_ADR_ACC, cmd, 1);
lpeters 34:341fb423e74b 1190 i2c.read(LSM303_ADR_ACC, &buf[0], 1);
lpeters 34:341fb423e74b 1191 cmd[0] = LSM303_REG_ACC_OUT_X_H_A;
lpeters 34:341fb423e74b 1192 i2c.write(LSM303_ADR_ACC, cmd, 1);
lpeters 34:341fb423e74b 1193 i2c.read(LSM303_ADR_ACC, &buf[1], 1);
lpeters 34:341fb423e74b 1194 cmd[0] = LSM303_REG_ACC_OUT_Y_L_A;
lpeters 34:341fb423e74b 1195 i2c.write(LSM303_ADR_ACC, cmd, 1);
lpeters 34:341fb423e74b 1196 i2c.read(LSM303_ADR_ACC, &buf[2], 1);
lpeters 34:341fb423e74b 1197 cmd[0] = LSM303_REG_ACC_OUT_Y_H_A;
lpeters 34:341fb423e74b 1198 i2c.write(LSM303_ADR_ACC, cmd, 1);
lpeters 34:341fb423e74b 1199 i2c.read(LSM303_ADR_ACC, &buf[3], 1);
lpeters 34:341fb423e74b 1200 cmd[0] = LSM303_REG_ACC_OUT_Z_L_A;
lpeters 34:341fb423e74b 1201 i2c.write(LSM303_ADR_ACC, cmd, 1);
lpeters 34:341fb423e74b 1202 i2c.read(LSM303_ADR_ACC, &buf[4], 1);
lpeters 34:341fb423e74b 1203 cmd[0] = LSM303_REG_ACC_OUT_Z_H_A;
lpeters 34:341fb423e74b 1204 i2c.write(LSM303_ADR_ACC, cmd, 1);
lpeters 34:341fb423e74b 1205 i2c.read(LSM303_ADR_ACC, &buf[5], 1);
lpeters 34:341fb423e74b 1206 myAccX = ((int16_t)(buf[0] | (buf[1] << 8)) >> accShift);
lpeters 34:341fb423e74b 1207 myAccY = ((int16_t)(buf[2] | (buf[3] << 8)) >> accShift);
lpeters 34:341fb423e74b 1208 myAccZ = ((int16_t)(buf[4] | (buf[5] << 8)) >> accShift);
lpeters 34:341fb423e74b 1209 if (myAccX < accMinX)
lpeters 34:341fb423e74b 1210 accMinX = myAccX;
lpeters 34:341fb423e74b 1211 if (myAccY < accMinY)
lpeters 34:341fb423e74b 1212 accMinY = myAccY;
lpeters 34:341fb423e74b 1213 if (myAccZ < accMinZ)
lpeters 34:341fb423e74b 1214 accMinZ = myAccZ;
lpeters 34:341fb423e74b 1215 if (myAccX > accMaxX)
lpeters 34:341fb423e74b 1216 accMaxX = myAccX;
lpeters 34:341fb423e74b 1217 if (myAccY > accMaxY)
lpeters 34:341fb423e74b 1218 accMaxY = myAccY;
lpeters 34:341fb423e74b 1219 if (myAccZ > accMaxZ)
lpeters 34:341fb423e74b 1220 accMaxZ = myAccZ;
lpeters 34:341fb423e74b 1221 cmd[0] = LSM303_REG_ACC_INT1_SRC_A;
lpeters 34:341fb423e74b 1222 i2c.write(LSM303_ADR_ACC, cmd, 1);
lpeters 34:341fb423e74b 1223 i2c.read(LSM303_ADR_ACC, &ret, 1);
lpeters 34:341fb423e74b 1224 if (ret & 0x40)
lpeters 34:341fb423e74b 1225 {
lpeters 34:341fb423e74b 1226 accSFire++;
lpeters 34:341fb423e74b 1227 if (accEvent == 1)
lpeters 34:341fb423e74b 1228 {
lpeters 34:341fb423e74b 1229 accEvent = 0;
lpeters 34:341fb423e74b 1230 accSLIRQ++;
lpeters 34:341fb423e74b 1231 cmd[0] = LSM303_REG_ACC_INT1_THS_A;
lpeters 34:341fb423e74b 1232 cmd[1] = 0x7D;
lpeters 34:341fb423e74b 1233 i2c.write(LSM303_ADR_ACC, cmd, 2);
lpeters 34:341fb423e74b 1234 cmd[0] = LSM303_REG_ACC_INT1_DURATION_A;
lpeters 34:341fb423e74b 1235 cmd[1] = 0x00;
lpeters 34:341fb423e74b 1236 i2c.write(LSM303_ADR_ACC, cmd, 2);
lpeters 34:341fb423e74b 1237 cmd[0] = LSM303_REG_ACC_INT1_CFG_A;
lpeters 34:341fb423e74b 1238 cmd[1] = 0x2A;
lpeters 34:341fb423e74b 1239 i2c.write(LSM303_ADR_ACC, cmd, 2);
lpeters 34:341fb423e74b 1240 }
lpeters 34:341fb423e74b 1241 else
lpeters 34:341fb423e74b 1242 {
lpeters 34:341fb423e74b 1243 accEvent = 1;
lpeters 34:341fb423e74b 1244 accSHIRQ++;
lpeters 34:341fb423e74b 1245 cmd[0] = LSM303_REG_ACC_INT1_THS_A;
lpeters 34:341fb423e74b 1246 cmd[1] = 0x50;
lpeters 34:341fb423e74b 1247 i2c.write(LSM303_ADR_ACC, cmd, 2);
lpeters 34:341fb423e74b 1248 cmd[0] = LSM303_REG_ACC_INT1_DURATION_A;
lpeters 34:341fb423e74b 1249 //cmd[1] = 0x7D;
lpeters 34:341fb423e74b 1250 cmd[1] = 0x03;
lpeters 34:341fb423e74b 1251 i2c.write(LSM303_ADR_ACC, cmd, 2);
lpeters 34:341fb423e74b 1252 cmd[0] = LSM303_REG_ACC_INT1_CFG_A;
lpeters 34:341fb423e74b 1253 cmd[1] = 0x95;
lpeters 34:341fb423e74b 1254 i2c.write(LSM303_ADR_ACC, cmd, 2);
lpeters 34:341fb423e74b 1255 }
lpeters 34:341fb423e74b 1256 }
lpeters 34:341fb423e74b 1257 printf("A|%02X|%02X %02X %02X %02X %02X %02X|%*d,%*d,%*d|%*d,%*d,%*d|%*d,%*d,%*d|%02X|%02X/%02X %02X/%02X\r\n", rda, buf[0], buf[1], buf[2], buf[3], buf[4], buf[5], 6, myAccX, 6, myAccY, 6, myAccZ, 6, accMinX, 6, accMinY, 6, accMinZ, 6, accMaxX, 6, accMaxY, 6, accMaxZ, ret, accSHIRQ, accSLIRQ, accSFire, accHFire);
lpeters 34:341fb423e74b 1258 }
lpeters 34:341fb423e74b 1259 }
lpeters 34:341fb423e74b 1260
lpeters 34:341fb423e74b 1261 void tmpRead()
lpeters 34:341fb423e74b 1262 {
lpeters 34:341fb423e74b 1263 #if defined(TARGET_LRAT)
lpeters 34:341fb423e74b 1264 cmd[0] = LSM303_REG_MAG_TEMP_L_M;
lpeters 34:341fb423e74b 1265 i2c.write(LSM303_ADR_MAG, cmd, 1);
lpeters 34:341fb423e74b 1266 i2c.read(LSM303_ADR_MAG, &buf[0], 1);
lpeters 34:341fb423e74b 1267 cmd[0] = LSM303_REG_MAG_TEMP_H_M;
lpeters 34:341fb423e74b 1268 i2c.write(LSM303_ADR_MAG, cmd, 1);
lpeters 34:341fb423e74b 1269 i2c.read(LSM303_ADR_MAG, &buf[1], 1);
lpeters 34:341fb423e74b 1270 myTemp = (int16_t)(buf[0] | (buf[1] << 8));
lpeters 34:341fb423e74b 1271 printf("T|%02X %02X| (%d)\r\n", buf[0], buf[1], myTemp);
lpeters 34:341fb423e74b 1272 #else
lpeters 34:341fb423e74b 1273 cmd[0] = LSM303_REG_ACC_STATUS_REG_AUX_A;
lpeters 34:341fb423e74b 1274 i2c.write(LSM303_ADR_ACC, cmd, 1);
lpeters 34:341fb423e74b 1275 i2c.read(LSM303_ADR_ACC, &rda, 1);
lpeters 34:341fb423e74b 1276 if (rda & 0x04)
lpeters 34:341fb423e74b 1277 {
lpeters 34:341fb423e74b 1278 cmd[0] = LSM303_REG_ACC_OUT_TEMP_L_A | 0x80;
lpeters 34:341fb423e74b 1279 i2c.write(LSM303_ADR_ACC, cmd, 1);
lpeters 34:341fb423e74b 1280 i2c.read(LSM303_ADR_ACC, &buf[0], 2);
lpeters 34:341fb423e74b 1281 myTemp = (int16_t)(buf[0] | (buf[1] << 8)) >> 6;
lpeters 34:341fb423e74b 1282 printf("T|%02X %02X %02X| (%d)\r\n", rda, buf[0], buf[1], myTemp);
lpeters 34:341fb423e74b 1283 }
lpeters 34:341fb423e74b 1284 #endif
lpeters 34:341fb423e74b 1285 }
lpeters 34:341fb423e74b 1286
Huot87 38:fd7a407bfe3e 1287
Huot87 38:fd7a407bfe3e 1288 // HUOT Alteration -- Change GPS read from "void" to return "int" to solidfy if fix was good or bad
Huot87 38:fd7a407bfe3e 1289 int gpsRead()
lpeters 34:341fb423e74b 1290 {
lpeters 34:341fb423e74b 1291 bool gpsDone = false;
lpeters 34:341fb423e74b 1292 bool fixGood = false;
lpeters 35:73b3963c6dd3 1293 uint8_t crcPass = 0;
lpeters 35:73b3963c6dd3 1294 uint8_t crcFail = 0;
lpeters 35:73b3963c6dd3 1295 uint32_t tDate = 0;
lpeters 35:73b3963c6dd3 1296 uint32_t tTime = 0;
lpeters 34:341fb423e74b 1297 myLedW = 1;
lpeters 34:341fb423e74b 1298 pos = 0;
lpeters 33:e47306c32791 1299 ret = 0xFF;
lpeters 33:e47306c32791 1300 cmd[0] = 0xFF;
lpeters 33:e47306c32791 1301 i2c.write(NEOM8M_ADR_GPS, cmd, 1);
lpeters 33:e47306c32791 1302 while(!gpsDone)
lpeters 33:e47306c32791 1303 {
lpeters 33:e47306c32791 1304 while (ret == 0xFF)
lpeters 33:e47306c32791 1305 {
lpeters 33:e47306c32791 1306 i2c.read(NEOM8M_ADR_GPS, &ret, 1);
lpeters 33:e47306c32791 1307 }
lpeters 33:e47306c32791 1308 while (ret != 0xFF)
lpeters 33:e47306c32791 1309 {
lpeters 33:e47306c32791 1310 buf[pos++] = ret;
lpeters 33:e47306c32791 1311 i2c.read(NEOM8M_ADR_GPS, &ret, 1);
lpeters 33:e47306c32791 1312 if (ret == '\r')
lpeters 33:e47306c32791 1313 {
lpeters 33:e47306c32791 1314 i2c.read(NEOM8M_ADR_GPS, &ret, 1);
lpeters 33:e47306c32791 1315 if (ret == '\n')
lpeters 33:e47306c32791 1316 {
lpeters 33:e47306c32791 1317 buf[pos] = 0x00;
lpeters 34:341fb423e74b 1318 // NMEA Validation
lpeters 33:e47306c32791 1319 uint16_t crc = 0;
lpeters 35:73b3963c6dd3 1320 char clr = '\0';
lpeters 33:e47306c32791 1321 if (buf[0] == '$' && buf[pos-3] == '*')
lpeters 33:e47306c32791 1322 {
lpeters 35:73b3963c6dd3 1323 for (int i = 1; i < pos-3; i++)
lpeters 33:e47306c32791 1324 {
lpeters 33:e47306c32791 1325 crc ^= buf[i];
lpeters 33:e47306c32791 1326 }
lpeters 33:e47306c32791 1327 }
lpeters 33:e47306c32791 1328 if (crc == ((buf[pos-2] < 'A' ? buf[pos-2] - '0' : buf[pos-2] - '7') << 4 | (buf[pos-1] < 'A' ? buf[pos-1] - '0' : buf[pos-1] - '7')))
lpeters 35:73b3963c6dd3 1329 {
lpeters 33:e47306c32791 1330 clr = '2'; // 2 = Green
lpeters 35:73b3963c6dd3 1331 crcPass++;
lpeters 35:73b3963c6dd3 1332 }
lpeters 33:e47306c32791 1333 else
lpeters 35:73b3963c6dd3 1334 {
lpeters 33:e47306c32791 1335 clr = '1'; // 1 = Red
lpeters 35:73b3963c6dd3 1336 crcFail++;
lpeters 35:73b3963c6dd3 1337 }
lpeters 33:e47306c32791 1338 printf("GPS: [\u001b[3%cm%02X\u001b[0m] |%s|\r\n", clr, crc, buf);
lpeters 35:73b3963c6dd3 1339 if (clr == '2')
lpeters 35:73b3963c6dd3 1340 {
lpeters 33:e47306c32791 1341 // Global Positioning System Fix Data
lpeters 33:e47306c32791 1342 if(strncmp(buf, "$GNGGA", 6) == 0)
lpeters 33:e47306c32791 1343 {
lpeters 33:e47306c32791 1344 printf("GNGGA> ");
lpeters 33:e47306c32791 1345 //sscanf(cmd, "$GPGGA,%f,%f,%c,%f,%c,%d,%d,%*f,%f", &timefix, &latitude, &ns, &longitude, &ew, &fq, &nst, &altitude);
lpeters 33:e47306c32791 1346 //pc.printf("GPGGA Fix taken at: %f, Latitude: %f %c, Longitude: %f %c, Fix quality: %d, Number of sat: %d, Altitude: %f M\n", timefix, latitude, ns, longitude, ew, fq, nst, altitude);
lpeters 33:e47306c32791 1347 float fldTim, fldAlt;
lpeters 33:e47306c32791 1348 double fldLat, fldLon;
lpeters 33:e47306c32791 1349 char fldN_S, fldE_W;
lpeters 33:e47306c32791 1350 int fldFix, fldSat;
lpeters 33:e47306c32791 1351 sscanf(buf, "$GNGGA,%f,%lf,%c,%lf,%c,%d,%d,%*f,%f", &fldTim, &fldLat, &fldN_S, &fldLon, &fldE_W, &fldFix, &fldSat, &fldAlt);
lpeters 33:e47306c32791 1352 printf("Sec: %.2f, Lat: %.5f %c, Lon: %.5f %c, Fix: %d, Sat: %d, Alt: %.1f M\r\n", fldTim, fldLat, fldN_S, fldLon, fldE_W, fldFix, fldSat, fldAlt);
lpeters 33:e47306c32791 1353 if (clr == '2')
lpeters 33:e47306c32791 1354 {
lpeters 33:e47306c32791 1355 mylat = fldLat / (fldN_S == 'S' ? -100 : 100);
lpeters 33:e47306c32791 1356 mylon = fldLon / (fldE_W == 'W' ? -100 : 100);
lpeters 35:73b3963c6dd3 1357 //mytime = (uint32_t)fldTim;
lpeters 33:e47306c32791 1358 mybatt = (fldSat & 0xF0 ? 0x0F : fldSat & 0x0F);
lpeters 33:e47306c32791 1359 }
lpeters 33:e47306c32791 1360 }
lpeters 33:e47306c32791 1361 // Satellite status
lpeters 33:e47306c32791 1362 if(strncmp(buf, "$GNGSA", 6) == 0)
lpeters 33:e47306c32791 1363 {
lpeters 35:73b3963c6dd3 1364 //printf("GNGSA> ");
lpeters 33:e47306c32791 1365 //sscanf(cmd, "$GPGSA,%c,%d,%d", &tf, &fix, &nst);
lpeters 33:e47306c32791 1366 //pc.printf("GPGSA Type fix: %c, 3D fix: %d, number of sat: %d\r\n", tf, fix, nst);
lpeters 33:e47306c32791 1367 char fldTyp;
lpeters 33:e47306c32791 1368 int fldDim, fldSat;
lpeters 33:e47306c32791 1369 sscanf(buf, "$GNGSA,%c,%d,%d", &fldTyp, &fldDim, &fldSat);
lpeters 35:73b3963c6dd3 1370 //printf("Typ: %c, Pos: %d, Sat: %d\r\n", fldTyp, fldDim, fldSat);
lpeters 33:e47306c32791 1371 }
lpeters 33:e47306c32791 1372 // Geographic position, Latitude and Longitude
lpeters 33:e47306c32791 1373 if(strncmp(buf, "$GNGLL", 6) == 0)
lpeters 33:e47306c32791 1374 {
lpeters 35:73b3963c6dd3 1375 //printf("GNGLL> ");
lpeters 33:e47306c32791 1376 //sscanf(cmd, "$GPGLL,%f,%c,%f,%c,%f", &latitude, &ns, &longitude, &ew, &timefix);
lpeters 33:e47306c32791 1377 //pc.printf("GPGLL Latitude: %f %c, Longitude: %f %c, Fix taken at: %f\n", latitude, ns, longitude, ew, timefix);
lpeters 33:e47306c32791 1378 float fldTim;
lpeters 33:e47306c32791 1379 double fldLat, fldLon;
lpeters 33:e47306c32791 1380 char fldN_S, fldE_W;
lpeters 33:e47306c32791 1381 sscanf(buf, "$GNGLL,%lf,%c,%lf,%c,%f", &fldLat, &fldN_S, &fldLon, &fldE_W, &fldTim);
lpeters 35:73b3963c6dd3 1382 //printf("Lat: %.5f %c, Lon: %.5f %c, Sec: %.2f\r\n", fldLat, fldN_S, fldLon, fldE_W, fldTim);
lpeters 33:e47306c32791 1383 }
lpeters 33:e47306c32791 1384 // Geographic position, Latitude and Longitude
lpeters 33:e47306c32791 1385 if(strncmp(buf, "$GNRMC", 6) == 0)
lpeters 33:e47306c32791 1386 {
lpeters 35:73b3963c6dd3 1387 //printf("GPS: [\u001b[3%cm%02X\u001b[0m] |%s|\r\n", clr, crc, buf);
lpeters 33:e47306c32791 1388 printf("GNRMC> ");
lpeters 33:e47306c32791 1389 //sscanf(cmd, "$GPRMC,%f,%c,%f,%c,%f,%c,%f,,%d", &timefix, &status, &latitude, &ns, &longitude, &ew, &speed, &date);
lpeters 33:e47306c32791 1390 //pc.printf("GPRMC Fix taken at: %f, Status: %c, Latitude: %f %c, Longitude: %f %c, Speed: %f, Date: %d\n", timefix, status, latitude, ns, longitude, ew, speed, date);
lpeters 35:73b3963c6dd3 1391 float fldTim, fldSpd, fldTrk;
lpeters 35:73b3963c6dd3 1392 fldTrk = 0;
lpeters 33:e47306c32791 1393 double fldLat, fldLon;
lpeters 33:e47306c32791 1394 char fldSts, fldN_S, fldE_W;
lpeters 35:73b3963c6dd3 1395 uint32_t fldDat;
lpeters 35:73b3963c6dd3 1396 if (sscanf(buf, "$GNRMC,,%c", &fldSts) != 1 &&
lpeters 35:73b3963c6dd3 1397 sscanf(buf, "$GNRMC,%f,%c,,,,,,,%d", &fldTim, &fldSts, &fldDat) != 3 &&
lpeters 35:73b3963c6dd3 1398 sscanf(buf, "$GNRMC,%f,%c,%lf,%c,%lf,%c,%f,,%d", &fldTim, &fldSts, &fldLat, &fldN_S, &fldLon, &fldE_W, &fldSpd, &fldDat) != 8 &&
lpeters 35:73b3963c6dd3 1399 sscanf(buf, "$GNRMC,%f,%c,%lf,%c,%lf,%c,%f,%f,%d", &fldTim, &fldSts, &fldLat, &fldN_S, &fldLon, &fldE_W, &fldSpd, &fldTrk, &fldDat) != 9)
lpeters 35:73b3963c6dd3 1400 printf("[\u001b[33mWARN\u001b[0m] Invalid GNRMC packet detected.\r\n");
lpeters 35:73b3963c6dd3 1401 //sscanf(buf, "$GNRMC,%f,%c,%lf,%c,%lf,%c,%f,%7[^,],%d", &fldTim, &fldSts, &fldLat, &fldN_S, &fldLon, &fldE_W, &fldSpd, fldFoo, &fldDat);
lpeters 33:e47306c32791 1402 printf("Sec: %.2f, Sts: %c, Lat: %.5f %c, Lon: %.5f %c, Spd: %.3f, Dat: %06d\r\n", fldTim, fldSts, fldLat, fldN_S, fldLon, fldE_W, fldSpd, fldDat);
lpeters 35:73b3963c6dd3 1403 if (clr == '2')
lpeters 35:73b3963c6dd3 1404 {
lpeters 35:73b3963c6dd3 1405 tTime = (uint32_t)fldTim;
lpeters 35:73b3963c6dd3 1406 tDate = fldDat;
lpeters 35:73b3963c6dd3 1407 if (fldSts == 'A')
lpeters 35:73b3963c6dd3 1408 fixGood = true;
lpeters 35:73b3963c6dd3 1409 }
lpeters 35:73b3963c6dd3 1410 }
lpeters 33:e47306c32791 1411 }
lpeters 33:e47306c32791 1412 pos = 0;
lpeters 33:e47306c32791 1413 i2c.read(NEOM8M_ADR_GPS, &ret, 1);
lpeters 33:e47306c32791 1414 }
lpeters 33:e47306c32791 1415 else
lpeters 33:e47306c32791 1416 {
lpeters 35:73b3963c6dd3 1417 printf("[\u001b[33mWARN\u001b[0m] Expected '0A', received '%02X'.\r\n", ret);
lpeters 33:e47306c32791 1418 }
lpeters 33:e47306c32791 1419 }
lpeters 37:df69df1bcb1a 1420 //else if (pos == 82)
lpeters 37:df69df1bcb1a 1421 else if (pos == 191)
lpeters 33:e47306c32791 1422 {
lpeters 33:e47306c32791 1423 buf[pos] = 0x00;
lpeters 33:e47306c32791 1424 printf("GPS: |%s| ...\r\n", buf);
lpeters 33:e47306c32791 1425 pos = 0;
lpeters 33:e47306c32791 1426 i2c.read(NEOM8M_ADR_GPS, &ret, 1);
lpeters 33:e47306c32791 1427 }
lpeters 33:e47306c32791 1428 }
lpeters 33:e47306c32791 1429 buf[pos] = 0x00;
lpeters 33:e47306c32791 1430 gpsDone = true;
lpeters 33:e47306c32791 1431 }
lpeters 33:e47306c32791 1432 if (pos > 0)
lpeters 33:e47306c32791 1433 printf("GPS: |%s|\r\n", buf);
lpeters 34:341fb423e74b 1434 myLedW = 0;
lpeters 35:73b3963c6dd3 1435 if (crcFail)
lpeters 35:73b3963c6dd3 1436 printf("[\u001b[33mWARN\u001b[0m] CRC PASS: %d FAIL: %d\r\n", crcPass, crcFail);
lpeters 35:73b3963c6dd3 1437
lpeters 35:73b3963c6dd3 1438 struct tm ts;
lpeters 35:73b3963c6dd3 1439 time_t t;
lpeters 35:73b3963c6dd3 1440
lpeters 35:73b3963c6dd3 1441 uint8_t tDay = tDate / 10000;
lpeters 35:73b3963c6dd3 1442 uint8_t tMon = (tDate - (tDay * 10000)) / 100;
lpeters 35:73b3963c6dd3 1443 uint8_t tYear = (tDate - ((tDay * 10000) + (tMon * 100))) + 100;
lpeters 35:73b3963c6dd3 1444 uint8_t tHour = tTime / 10000;
lpeters 35:73b3963c6dd3 1445 uint8_t tMin = (tTime - (tHour * 10000)) / 100;
lpeters 35:73b3963c6dd3 1446 uint8_t tSec = (tTime - ((tHour * 10000) + (tMin * 100)));
lpeters 35:73b3963c6dd3 1447
lpeters 35:73b3963c6dd3 1448 ts.tm_year = tYear;
lpeters 35:73b3963c6dd3 1449 ts.tm_mon = tMon - 1;
lpeters 35:73b3963c6dd3 1450 ts.tm_mday = tDay;
lpeters 35:73b3963c6dd3 1451 ts.tm_hour = tHour;
lpeters 35:73b3963c6dd3 1452 ts.tm_min = tMin;
lpeters 35:73b3963c6dd3 1453 ts.tm_sec = tSec;
lpeters 35:73b3963c6dd3 1454 t = mktime(&ts);
lpeters 35:73b3963c6dd3 1455 //printf("DAT: %06d TIM: %d\r\n", tDate, tTime);
lpeters 35:73b3963c6dd3 1456 //printf("CNV: %04d-%02d-%02d@%02d:%02d:%02d\r\n", tYear, tMon, tDay, tHour, tMin, tSec);
lpeters 35:73b3963c6dd3 1457 //printf("T: %d\t%s", t, ctime(&t));
lpeters 35:73b3963c6dd3 1458 printf("GPS: %08X\t%s", t, ctime(&t));
lpeters 35:73b3963c6dd3 1459 mytime = t;
lpeters 35:73b3963c6dd3 1460
lpeters 34:341fb423e74b 1461 if (fixGood)
lpeters 34:341fb423e74b 1462 myLedG = 1;
lpeters 34:341fb423e74b 1463 else
lpeters 34:341fb423e74b 1464 myLedR = 1;
lpeters 33:e47306c32791 1465
lpeters 34:341fb423e74b 1466 for (int i = 0; i < 10; i++) {
lpeters 34:341fb423e74b 1467 myLedB = 1;
lpeters 34:341fb423e74b 1468 wait(0.1);
lpeters 34:341fb423e74b 1469 myLedB = 0;
lpeters 34:341fb423e74b 1470 wait(0.1);
mbed_official 0:7037ed05f54f 1471 }
Huot87 38:fd7a407bfe3e 1472
Huot87 38:fd7a407bfe3e 1473 if (fixGood)
Huot87 38:fd7a407bfe3e 1474 return 0;
Huot87 38:fd7a407bfe3e 1475 else
Huot87 38:fd7a407bfe3e 1476 return 1;
mbed_official 0:7037ed05f54f 1477 }
mbed_official 0:7037ed05f54f 1478
lpeters 37:df69df1bcb1a 1479 void ubxRead()
lpeters 37:df69df1bcb1a 1480 {
lpeters 37:df69df1bcb1a 1481 uint8_t crcPass = 0;
lpeters 37:df69df1bcb1a 1482 uint8_t crcFail = 0;
lpeters 37:df69df1bcb1a 1483
lpeters 37:df69df1bcb1a 1484 myLedW = 1;
lpeters 37:df69df1bcb1a 1485 pos = 0;
lpeters 37:df69df1bcb1a 1486 ret = 0xFF;
lpeters 37:df69df1bcb1a 1487 cmd[0] = 0xFF;
lpeters 37:df69df1bcb1a 1488 i2c.write(NEOM8M_ADR_GPS, cmd, 1);
lpeters 37:df69df1bcb1a 1489 while (ret == 0xFF)
lpeters 37:df69df1bcb1a 1490 {
lpeters 37:df69df1bcb1a 1491 i2c.read(NEOM8M_ADR_GPS, &ret, 1);
lpeters 37:df69df1bcb1a 1492 }
lpeters 37:df69df1bcb1a 1493 while (ret != 0xFF)
lpeters 37:df69df1bcb1a 1494 {
lpeters 37:df69df1bcb1a 1495 buf[pos++] = ret;
lpeters 37:df69df1bcb1a 1496 i2c.read(NEOM8M_ADR_GPS, &ret, 1);
lpeters 37:df69df1bcb1a 1497 }
lpeters 37:df69df1bcb1a 1498 printf("UBX: | ");
lpeters 37:df69df1bcb1a 1499 for (int i = 0; i <= pos; i++) { printf("%02X ", buf[i]); }
lpeters 37:df69df1bcb1a 1500 printf("|\r\n", buf);
lpeters 37:df69df1bcb1a 1501 myLedW = 0;
lpeters 37:df69df1bcb1a 1502 //if (crcFail)
lpeters 37:df69df1bcb1a 1503 // printf("[\u001b[33mWARN\u001b[0m] CRC PASS: %d FAIL: %d\r\n", crcPass, crcFail);
lpeters 37:df69df1bcb1a 1504
lpeters 37:df69df1bcb1a 1505 if (pos > 0)
lpeters 37:df69df1bcb1a 1506 myLedG = 1;
lpeters 37:df69df1bcb1a 1507 else
lpeters 37:df69df1bcb1a 1508 myLedR = 1;
lpeters 37:df69df1bcb1a 1509
lpeters 37:df69df1bcb1a 1510 for (int i = 0; i < 10; i++) {
lpeters 37:df69df1bcb1a 1511 myLedB = 1;
lpeters 37:df69df1bcb1a 1512 wait(0.1);
lpeters 37:df69df1bcb1a 1513 myLedB = 0;
lpeters 37:df69df1bcb1a 1514 wait(0.1);
lpeters 37:df69df1bcb1a 1515 }
lpeters 37:df69df1bcb1a 1516 }
lpeters 37:df69df1bcb1a 1517
mbed_official 0:7037ed05f54f 1518 // EOF