micro code for pen oscilloscope
Dependencies: BLE_API circular_buffer mbed nRF51822
Fork of BLENano_SimpleControls by
main.cpp@7:7a3b7d1c8393, 2015-03-24 (annotated)
- Committer:
- aadavids
- Date:
- Tue Mar 24 02:41:05 2015 +0000
- Revision:
- 7:7a3b7d1c8393
- Parent:
- 6:e19c2a022a95
fixed trigering logic
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
RedBearLab | 0:be2e4095513a | 1 | #include "mbed.h" |
RedBearLab | 0:be2e4095513a | 2 | #include "BLEDevice.h" |
aadavids | 5:4112d6243485 | 3 | #include "circular_buffer.h" |
aadavids | 4:635dcca9e11a | 4 | // Constants |
RedBearLab | 0:be2e4095513a | 5 | #define BLE_UUID_TXRX_SERVICE 0x0000 /**< The UUID of the Nordic UART Service. */ |
RedBearLab | 0:be2e4095513a | 6 | #define BLE_UUID_TX_CHARACTERISTIC 0x0002 /**< The UUID of the TX Characteristic. */ |
RedBearLab | 0:be2e4095513a | 7 | #define BLE_UUIDS_RX_CHARACTERISTIC 0x0003 /**< The UUID of the RX Characteristic. */ |
RedBearLab | 0:be2e4095513a | 8 | |
RedBearLab | 0:be2e4095513a | 9 | #define TXRX_BUF_LEN 20 |
RedBearLab | 0:be2e4095513a | 10 | |
aadavids | 3:6c83be282aac | 11 | //#define DIGITAL_OUT_PIN P0_9 //TXD |
aadavids | 3:6c83be282aac | 12 | //#define DIGITAL_IN_PIN P0_10 //CTS |
aadavids | 3:6c83be282aac | 13 | //#define ANALOG_IN_PIN P0_4 //P04 |
aadavids | 3:6c83be282aac | 14 | |
aadavids | 6:e19c2a022a95 | 15 | #define AC_EN_PIN P0_19 //FIXFIXFIXTHIS back // P0_4 |
aadavids | 3:6c83be282aac | 16 | #define DC_EN_PIN P0_5 |
aadavids | 3:6c83be282aac | 17 | #define PAIRING_LED_PIN P0_7 |
aadavids | 3:6c83be282aac | 18 | #define BYPASS_ADC_PIN P0_6 |
aadavids | 3:6c83be282aac | 19 | #define PAIRING_BUTTON_PIN P0_15 |
aadavids | 3:6c83be282aac | 20 | #define POS_OFFSET_EN_PIN P0_29 |
aadavids | 3:6c83be282aac | 21 | #define NEG_OFFSET_EN_PIN P0_28 |
aadavids | 3:6c83be282aac | 22 | #define STATUS_LED_PIN P0_11 |
aadavids | 5:4112d6243485 | 23 | #define RESET_PIN P0_9 |
RedBearLab | 0:be2e4095513a | 24 | |
aadavids | 4:635dcca9e11a | 25 | #define COUPLING_SETTING 0x1 |
aadavids | 4:635dcca9e11a | 26 | #define OFFSET_SETTING 0x2 |
aadavids | 5:4112d6243485 | 27 | #define OFFSET_DIR_SETTING 0x9 |
aadavids | 4:635dcca9e11a | 28 | #define TRIGGER_DIR_SETTING 0x3 |
aadavids | 4:635dcca9e11a | 29 | #define TRIGGER_VALUE_SETTING 0x4 |
aadavids | 4:635dcca9e11a | 30 | #define AVERAGING_SETTING 0x5 |
aadavids | 4:635dcca9e11a | 31 | #define VOLTAGE_RANGE_SETTING 0x6 |
aadavids | 4:635dcca9e11a | 32 | #define TIME_SHIFT_SETTING 0x7 |
aadavids | 4:635dcca9e11a | 33 | #define TIME_RANGE_SETTING 0x8 |
aadavids | 2:ddf1f6325a37 | 34 | |
aadavids | 4:635dcca9e11a | 35 | #define AC_COUPLING 0 |
aadavids | 4:635dcca9e11a | 36 | #define DC_COUPLING 1 |
aadavids | 7:7a3b7d1c8393 | 37 | #define FALLING_EDGE 0 |
aadavids | 7:7a3b7d1c8393 | 38 | #define RISING_EDGE 1 |
aadavids | 5:4112d6243485 | 39 | #define NEG_OFFSET 0 |
aadavids | 5:4112d6243485 | 40 | #define POS_OFFSET 1 |
aadavids | 4:635dcca9e11a | 41 | |
aadavids | 4:635dcca9e11a | 42 | // Global Settings |
aadavids | 6:e19c2a022a95 | 43 | bool coupling_type = 1; // 0 is AC, 1 is DC |
aadavids | 6:e19c2a022a95 | 44 | uint8_t offset_value = 0; |
aadavids | 6:e19c2a022a95 | 45 | bool trigger_dir = 1; // 0 is negative, 1 is positive |
aadavids | 6:e19c2a022a95 | 46 | bool offset_dir = 1; // 0 is negative, 1 is positive |
aadavids | 6:e19c2a022a95 | 47 | uint8_t trigger_level = 127; |
aadavids | 6:e19c2a022a95 | 48 | uint8_t voltage_range = 1; |
aadavids | 6:e19c2a022a95 | 49 | uint8_t averaging_amount = 1; |
aadavids | 6:e19c2a022a95 | 50 | uint8_t time_shift_value = 0; |
aadavids | 6:e19c2a022a95 | 51 | uint8_t time_range_value = 0; |
aadavids | 2:ddf1f6325a37 | 52 | |
RedBearLab | 0:be2e4095513a | 53 | BLEDevice ble; |
RedBearLab | 0:be2e4095513a | 54 | |
aadavids | 4:635dcca9e11a | 55 | // Pins declaration |
aadavids | 4:635dcca9e11a | 56 | DigitalOut AC_EN(AC_EN_PIN); |
aadavids | 4:635dcca9e11a | 57 | DigitalOut DC_EN(DC_EN_PIN); |
aadavids | 4:635dcca9e11a | 58 | DigitalOut PAIRING_LED(PAIRING_LED_PIN); |
aadavids | 5:4112d6243485 | 59 | AnalogIn ANALOG(BYPASS_ADC_PIN); |
aadavids | 4:635dcca9e11a | 60 | DigitalIn PARING_BUTTON(PAIRING_BUTTON_PIN); |
aadavids | 4:635dcca9e11a | 61 | DigitalOut NEG_OFFSET_EN(NEG_OFFSET_EN_PIN); |
aadavids | 4:635dcca9e11a | 62 | DigitalOut POS_OFFSET_EN(POS_OFFSET_EN_PIN); |
aadavids | 4:635dcca9e11a | 63 | DigitalOut STATUS_LED(STATUS_LED_PIN); |
RedBearLab | 0:be2e4095513a | 64 | |
RedBearLab | 0:be2e4095513a | 65 | //Serial pc(USBTX, USBRX); |
RedBearLab | 0:be2e4095513a | 66 | |
RedBearLab | 0:be2e4095513a | 67 | // The Nordic UART Service |
RedBearLab | 0:be2e4095513a | 68 | static const uint8_t uart_base_uuid[] = {0x71, 0x3D, 0, 0, 0x50, 0x3E, 0x4C, 0x75, 0xBA, 0x94, 0x31, 0x48, 0xF1, 0x8D, 0x94, 0x1E}; |
RedBearLab | 0:be2e4095513a | 69 | static const uint8_t uart_tx_uuid[] = {0x71, 0x3D, 0, 3, 0x50, 0x3E, 0x4C, 0x75, 0xBA, 0x94, 0x31, 0x48, 0xF1, 0x8D, 0x94, 0x1E}; |
RedBearLab | 0:be2e4095513a | 70 | static const uint8_t uart_rx_uuid[] = {0x71, 0x3D, 0, 2, 0x50, 0x3E, 0x4C, 0x75, 0xBA, 0x94, 0x31, 0x48, 0xF1, 0x8D, 0x94, 0x1E}; |
RedBearLab | 0:be2e4095513a | 71 | static const uint8_t uart_base_uuid_rev[] = {0x1E, 0x94, 0x8D, 0xF1, 0x48, 0x31, 0x94, 0xBA, 0x75, 0x4C, 0x3E, 0x50, 0, 0, 0x3D, 0x71}; |
RedBearLab | 0:be2e4095513a | 72 | |
RedBearLab | 0:be2e4095513a | 73 | |
RedBearLab | 0:be2e4095513a | 74 | uint8_t txPayload[TXRX_BUF_LEN] = {0,}; |
RedBearLab | 0:be2e4095513a | 75 | uint8_t rxPayload[TXRX_BUF_LEN] = {0,}; |
RedBearLab | 0:be2e4095513a | 76 | |
RedBearLab | 0:be2e4095513a | 77 | //static uint8_t rx_buf[TXRX_BUF_LEN]; |
RedBearLab | 0:be2e4095513a | 78 | //static uint8_t rx_len=0; |
RedBearLab | 0:be2e4095513a | 79 | |
RedBearLab | 0:be2e4095513a | 80 | |
RedBearLab | 0:be2e4095513a | 81 | GattCharacteristic txCharacteristic (uart_tx_uuid, txPayload, 1, TXRX_BUF_LEN, GattCharacteristic::BLE_GATT_CHAR_PROPERTIES_WRITE | GattCharacteristic::BLE_GATT_CHAR_PROPERTIES_WRITE_WITHOUT_RESPONSE); |
aadavids | 5:4112d6243485 | 82 | |
RedBearLab | 0:be2e4095513a | 83 | GattCharacteristic rxCharacteristic (uart_rx_uuid, rxPayload, 1, TXRX_BUF_LEN, GattCharacteristic::BLE_GATT_CHAR_PROPERTIES_NOTIFY); |
aadavids | 5:4112d6243485 | 84 | |
aadavids | 6:e19c2a022a95 | 85 | GattCharacteristic *uartChars[] = {&txCharacteristic, &rxCharacteristic}; |
RedBearLab | 0:be2e4095513a | 86 | |
RedBearLab | 0:be2e4095513a | 87 | GattService uartService(uart_base_uuid, uartChars, sizeof(uartChars) / sizeof(GattCharacteristic *)); |
RedBearLab | 0:be2e4095513a | 88 | |
RedBearLab | 0:be2e4095513a | 89 | |
RedBearLab | 0:be2e4095513a | 90 | void disconnectionCallback(Gap::Handle_t handle, Gap::DisconnectionReason_t reason) |
RedBearLab | 0:be2e4095513a | 91 | { |
RedBearLab | 0:be2e4095513a | 92 | //pc.printf("Disconnected \r\n"); |
RedBearLab | 0:be2e4095513a | 93 | //pc.printf("Restart advertising \r\n"); |
RedBearLab | 0:be2e4095513a | 94 | ble.startAdvertising(); |
RedBearLab | 0:be2e4095513a | 95 | } |
RedBearLab | 0:be2e4095513a | 96 | |
RedBearLab | 0:be2e4095513a | 97 | void WrittenHandler(const GattCharacteristicWriteCBParams *Handler) |
aadavids | 5:4112d6243485 | 98 | { |
RedBearLab | 0:be2e4095513a | 99 | uint8_t buf[TXRX_BUF_LEN]; |
RedBearLab | 0:be2e4095513a | 100 | uint16_t bytesRead; |
aadavids | 5:4112d6243485 | 101 | |
aadavids | 5:4112d6243485 | 102 | if (Handler->charHandle == txCharacteristic.getValueAttribute().getHandle()) { |
RedBearLab | 0:be2e4095513a | 103 | ble.readCharacteristicValue(txCharacteristic.getValueAttribute().getHandle(), buf, &bytesRead); |
RedBearLab | 0:be2e4095513a | 104 | memset(txPayload, 0, TXRX_BUF_LEN); |
aadavids | 5:4112d6243485 | 105 | memcpy(txPayload, buf, TXRX_BUF_LEN); |
aadavids | 5:4112d6243485 | 106 | |
RedBearLab | 0:be2e4095513a | 107 | //for(index=0; index<bytesRead; index++) |
aadavids | 5:4112d6243485 | 108 | //pc.putc(buf[index]); |
aadavids | 5:4112d6243485 | 109 | |
aadavids | 5:4112d6243485 | 110 | if(buf[0] == COUPLING_SETTING) { |
aadavids | 4:635dcca9e11a | 111 | coupling_type = buf[1]; |
aadavids | 5:4112d6243485 | 112 | if (coupling_type == AC_COUPLING) { |
aadavids | 4:635dcca9e11a | 113 | AC_EN = 1; |
aadavids | 4:635dcca9e11a | 114 | DC_EN = 0; |
aadavids | 4:635dcca9e11a | 115 | } else // DC coupling |
aadavids | 4:635dcca9e11a | 116 | AC_EN = 0; |
aadavids | 5:4112d6243485 | 117 | DC_EN = 1; |
aadavids | 4:635dcca9e11a | 118 | } |
aadavids | 5:4112d6243485 | 119 | } else if(buf[0] == TRIGGER_DIR_SETTING) { |
aadavids | 5:4112d6243485 | 120 | trigger_dir = buf[1]; |
aadavids | 5:4112d6243485 | 121 | } else if(buf[0] == AVERAGING_SETTING) { |
aadavids | 5:4112d6243485 | 122 | averaging_amount = buf[0]; |
aadavids | 5:4112d6243485 | 123 | } else if(buf[0] == TIME_SHIFT_SETTING) { |
aadavids | 5:4112d6243485 | 124 | time_shift_value = buf[1]; |
aadavids | 5:4112d6243485 | 125 | } else if(buf[0] == TIME_RANGE_SETTING) { |
aadavids | 5:4112d6243485 | 126 | time_range_value = buf[1]; |
aadavids | 5:4112d6243485 | 127 | } else if(buf[0] == OFFSET_SETTING) { |
aadavids | 5:4112d6243485 | 128 | offset_value = buf[1]; |
aadavids | 5:4112d6243485 | 129 | if (offset_dir == POS_OFFSET) { // postitive offset |
aadavids | 5:4112d6243485 | 130 | NEG_OFFSET_EN = 0; |
aadavids | 5:4112d6243485 | 131 | POS_OFFSET_EN = 1; |
aadavids | 5:4112d6243485 | 132 | } else { // negative offset |
aadavids | 5:4112d6243485 | 133 | NEG_OFFSET_EN = 1; |
aadavids | 5:4112d6243485 | 134 | POS_OFFSET_EN = 0; |
RedBearLab | 0:be2e4095513a | 135 | } |
aadavids | 5:4112d6243485 | 136 | } else if(buf[0] == TRIGGER_VALUE_SETTING) { |
aadavids | 5:4112d6243485 | 137 | trigger_level = buf[1]; |
RedBearLab | 0:be2e4095513a | 138 | } |
RedBearLab | 0:be2e4095513a | 139 | } |
aadavids | 7:7a3b7d1c8393 | 140 | |
aadavids | 7:7a3b7d1c8393 | 141 | bool is_rising_edge (uint8_t current_sample, uint8_t previous_sample) |
aadavids | 7:7a3b7d1c8393 | 142 | { |
aadavids | 7:7a3b7d1c8393 | 143 | return (current_sample > trigger_level && previous_sample < trigger_level); |
aadavids | 7:7a3b7d1c8393 | 144 | } |
aadavids | 7:7a3b7d1c8393 | 145 | |
aadavids | 7:7a3b7d1c8393 | 146 | bool is_falling_edge (uint8_t current_sample, uint8_t previous_sample) |
aadavids | 5:4112d6243485 | 147 | { |
aadavids | 7:7a3b7d1c8393 | 148 | return (current_sample > trigger_level && previous_sample < trigger_level); |
aadavids | 7:7a3b7d1c8393 | 149 | } |
aadavids | 7:7a3b7d1c8393 | 150 | |
aadavids | 7:7a3b7d1c8393 | 151 | bool is_triggered (uint8_t current_sample, uint8_t previous_sample, bool dir) { |
aadavids | 7:7a3b7d1c8393 | 152 | if (dir == RISING_EDGE) { |
aadavids | 7:7a3b7d1c8393 | 153 | return is_rising_edge (current_sample, previous_sample); |
aadavids | 7:7a3b7d1c8393 | 154 | } else { |
aadavids | 7:7a3b7d1c8393 | 155 | return is_falling_edge (current_sample, previous_sample); |
RedBearLab | 0:be2e4095513a | 156 | } |
RedBearLab | 0:be2e4095513a | 157 | } |
aadavids | 4:635dcca9e11a | 158 | |
aadavids | 6:e19c2a022a95 | 159 | #define VOLTAGE_BUFFER_SIZE 1024 |
aadavids | 5:4112d6243485 | 160 | circular_buffer<uint8_t> voltage_buffer(VOLTAGE_BUFFER_SIZE); |
aadavids | 5:4112d6243485 | 161 | uint8_t out_buf[VOLTAGE_BUFFER_SIZE]; |
aadavids | 7:7a3b7d1c8393 | 162 | void m_status_check_handle(void) |
aadavids | 7:7a3b7d1c8393 | 163 | { |
aadavids | 7:7a3b7d1c8393 | 164 | static bool is_shifting = false; |
aadavids | 5:4112d6243485 | 165 | static uint8_t time_shift = 0; |
aadavids | 5:4112d6243485 | 166 | static uint8_t prev_sample = 0; |
aadavids | 5:4112d6243485 | 167 | // Read and send out |
aadavids | 5:4112d6243485 | 168 | float s = ANALOG; |
aadavids | 5:4112d6243485 | 169 | uint8_t sample = s*255; |
aadavids | 5:4112d6243485 | 170 | voltage_buffer.push_back(sample); |
aadavids | 5:4112d6243485 | 171 | |
aadavids | 7:7a3b7d1c8393 | 172 | if ((is_shifting) || (voltage_buffer.get_size() == VOLTAGE_BUFFER_SIZE) && (is_triggered(sample, prev_sample, trigger_dir))) { |
aadavids | 7:7a3b7d1c8393 | 173 | if (is_rising_edge(sample, prev_sample) || is_falling_edge(sample, prev_sample)) { |
aadavids | 7:7a3b7d1c8393 | 174 | if (time_shift < time_shift_value) { |
aadavids | 7:7a3b7d1c8393 | 175 | is_shifting = true; |
aadavids | 7:7a3b7d1c8393 | 176 | time_shift++; |
aadavids | 7:7a3b7d1c8393 | 177 | } else { |
aadavids | 7:7a3b7d1c8393 | 178 | is_shifting = false; |
aadavids | 7:7a3b7d1c8393 | 179 | time_shift = 0; |
aadavids | 7:7a3b7d1c8393 | 180 | for (int i = 0; i < VOLTAGE_BUFFER_SIZE; i++) { |
aadavids | 7:7a3b7d1c8393 | 181 | out_buf[i] = voltage_buffer.front(); |
aadavids | 7:7a3b7d1c8393 | 182 | voltage_buffer.pop_front(); |
aadavids | 7:7a3b7d1c8393 | 183 | } |
aadavids | 7:7a3b7d1c8393 | 184 | ble.updateCharacteristicValue(rxCharacteristic.getValueAttribute().getHandle(), out_buf, VOLTAGE_BUFFER_SIZE); |
aadavids | 6:e19c2a022a95 | 185 | } |
aadavids | 7:7a3b7d1c8393 | 186 | } |
aadavids | 7:7a3b7d1c8393 | 187 | prev_sample = sample; |
aadavids | 7:7a3b7d1c8393 | 188 | } |
aadavids | 7:7a3b7d1c8393 | 189 | } |
aadavids | 7:7a3b7d1c8393 | 190 | |
aadavids | 7:7a3b7d1c8393 | 191 | int main(void) { |
aadavids | 7:7a3b7d1c8393 | 192 | Ticker ticker; |
aadavids | 7:7a3b7d1c8393 | 193 | ticker.attach_us(m_status_check_handle, 1000); |
aadavids | 7:7a3b7d1c8393 | 194 | |
aadavids | 7:7a3b7d1c8393 | 195 | ble.init(); |
aadavids | 7:7a3b7d1c8393 | 196 | ble.onDisconnection(disconnectionCallback); |
aadavids | 7:7a3b7d1c8393 | 197 | ble.onDataWritten(WrittenHandler); |
aadavids | 7:7a3b7d1c8393 | 198 | |
aadavids | 7:7a3b7d1c8393 | 199 | //pc.baud(9600); |
aadavids | 7:7a3b7d1c8393 | 200 | //pc.printf("SimpleChat Init \r\n"); |
aadavids | 7:7a3b7d1c8393 | 201 | |
aadavids | 7:7a3b7d1c8393 | 202 | //pc.attach( uartCB , pc.RxIrq); |
aadavids | 7:7a3b7d1c8393 | 203 | |
aadavids | 7:7a3b7d1c8393 | 204 | // setup advertising |
aadavids | 7:7a3b7d1c8393 | 205 | //ble.accumulateAdvertisingPayload(GapAdvertisingData::BREDR_NOT_SUPPORTED); |
aadavids | 7:7a3b7d1c8393 | 206 | ble.setAdvertisingType(GapAdvertisingParams::ADV_CONNECTABLE_UNDIRECTED); |
aadavids | 7:7a3b7d1c8393 | 207 | ble.accumulateAdvertisingPayload(GapAdvertisingData::SHORTENED_LOCAL_NAME, |
aadavids | 7:7a3b7d1c8393 | 208 | (const uint8_t *)"Serqet", sizeof("Serqet") - 1); |
aadavids | 7:7a3b7d1c8393 | 209 | ble.accumulateAdvertisingPayload(GapAdvertisingData::COMPLETE_LIST_128BIT_SERVICE_IDS, |
aadavids | 7:7a3b7d1c8393 | 210 | (const uint8_t *)uart_base_uuid_rev, sizeof(uart_base_uuid)); |
aadavids | 7:7a3b7d1c8393 | 211 | // 100ms; in multiples of 0.625ms. |
aadavids | 7:7a3b7d1c8393 | 212 | ble.setAdvertisingInterval(160); |
aadavids | 7:7a3b7d1c8393 | 213 | |
aadavids | 7:7a3b7d1c8393 | 214 | ble.addService(uartService); |
aadavids | 7:7a3b7d1c8393 | 215 | |
aadavids | 7:7a3b7d1c8393 | 216 | ble.startAdvertising(); |
aadavids | 7:7a3b7d1c8393 | 217 | |
aadavids | 7:7a3b7d1c8393 | 218 | //pc.printf("Advertising Start \r\n"); |
aadavids | 7:7a3b7d1c8393 | 219 | |
aadavids | 7:7a3b7d1c8393 | 220 | while(1) { |
aadavids | 7:7a3b7d1c8393 | 221 | ble.waitForEvent(); |
aadavids | 5:4112d6243485 | 222 | } |
RedBearLab | 0:be2e4095513a | 223 | } |
RedBearLab | 0:be2e4095513a | 224 | |
RedBearLab | 0:be2e4095513a | 225 | |
RedBearLab | 0:be2e4095513a | 226 | |
RedBearLab | 0:be2e4095513a | 227 | |
RedBearLab | 0:be2e4095513a | 228 | |
RedBearLab | 0:be2e4095513a | 229 | |
RedBearLab | 0:be2e4095513a | 230 | |
RedBearLab | 0:be2e4095513a | 231 | |
RedBearLab | 0:be2e4095513a | 232 | |
RedBearLab | 0:be2e4095513a | 233 | |
RedBearLab | 0:be2e4095513a | 234 | |
RedBearLab | 0:be2e4095513a | 235 | |
RedBearLab | 0:be2e4095513a | 236 | |
RedBearLab | 0:be2e4095513a | 237 | |
RedBearLab | 0:be2e4095513a | 238 | |
RedBearLab | 0:be2e4095513a | 239 | |
RedBearLab | 0:be2e4095513a | 240 | |
RedBearLab | 0:be2e4095513a | 241 | |
RedBearLab | 0:be2e4095513a | 242 | |
RedBearLab | 0:be2e4095513a | 243 | |
RedBearLab | 0:be2e4095513a | 244 | |
RedBearLab | 0:be2e4095513a | 245 | |
RedBearLab | 0:be2e4095513a | 246 | |
RedBearLab | 0:be2e4095513a | 247 | |
RedBearLab | 0:be2e4095513a | 248 | |
RedBearLab | 0:be2e4095513a | 249 | |
RedBearLab | 0:be2e4095513a | 250 | |
RedBearLab | 0:be2e4095513a | 251 | |
RedBearLab | 0:be2e4095513a | 252 | |
RedBearLab | 0:be2e4095513a | 253 | |
RedBearLab | 0:be2e4095513a | 254 |