Devchannel Team / X_NUCLEO_IDB0XA1

HW layer for the Nucleo board, it only work with old BLE_API

Dependents:   Hello_BLE F446RE-BLE

Fork of X_NUCLEO_IDB0XA1 by ST

BlueNRGDevice.cpp@91:97c0c21046b4, 2015-07-23 (annotated)

Committer:
Wolfgang Betz
Date:
Thu Jul 23 09:44:24 2015 +0200
Revision:
91:97c0c21046b4
Parent:
90:26c0c9807ab4
Child:
92:709d44dc869a
Improve waitForEvent()



- Enable also debug messages on console

Who changed what in which revision?

UserRevisionLine numberNew contents of line
Wolfgang Betz 90:26c0c9807ab4 1 /* mbed Microcontroller Library
Wolfgang Betz 90:26c0c9807ab4 2 * Copyright (c) 2006-2013 ARM Limited
Wolfgang Betz 90:26c0c9807ab4 3 *
Wolfgang Betz 90:26c0c9807ab4 4 * Licensed under the Apache License, Version 2.0 (the "License");
Wolfgang Betz 90:26c0c9807ab4 5 * you may not use this file except in compliance with the License.
Wolfgang Betz 90:26c0c9807ab4 6 * You may obtain a copy of the License at
Wolfgang Betz 90:26c0c9807ab4 7 *
Wolfgang Betz 90:26c0c9807ab4 8 * http://www.apache.org/licenses/LICENSE-2.0
Wolfgang Betz 90:26c0c9807ab4 9 *
Wolfgang Betz 90:26c0c9807ab4 10 * Unless required by applicable law or agreed to in writing, software
Wolfgang Betz 90:26c0c9807ab4 11 * distributed under the License is distributed on an "AS IS" BASIS,
Wolfgang Betz 90:26c0c9807ab4 12 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
Wolfgang Betz 90:26c0c9807ab4 13 * See the License for the specific language governing permissions and
Wolfgang Betz 90:26c0c9807ab4 14 * limitations under the License.
Wolfgang Betz 90:26c0c9807ab4 15 */
Wolfgang Betz 90:26c0c9807ab4 16
Wolfgang Betz 90:26c0c9807ab4 17 /**
Wolfgang Betz 90:26c0c9807ab4 18 ******************************************************************************
Wolfgang Betz 91:97c0c21046b4 19 * @file BlueNRGDevice.cpp
Wolfgang Betz 90:26c0c9807ab4 20 * @author STMicroelectronics
Wolfgang Betz 90:26c0c9807ab4 21 * @brief Implementation of BLEDeviceInstanceBase
Wolfgang Betz 90:26c0c9807ab4 22 ******************************************************************************
Wolfgang Betz 90:26c0c9807ab4 23 * @copy
Wolfgang Betz 90:26c0c9807ab4 24 *
Wolfgang Betz 90:26c0c9807ab4 25 * THE PRESENT FIRMWARE WHICH IS FOR GUIDANCE ONLY AIMS AT PROVIDING CUSTOMERS
Wolfgang Betz 90:26c0c9807ab4 26 * WITH CODING INFORMATION REGARDING THEIR PRODUCTS IN ORDER FOR THEM TO SAVE
Wolfgang Betz 90:26c0c9807ab4 27 * TIME. AS A RESULT, STMICROELECTRONICS SHALL NOT BE HELD LIABLE FOR ANY
Wolfgang Betz 90:26c0c9807ab4 28 * DIRECT, INDIRECT OR CONSEQUENTIAL DAMAGES WITH RESPECT TO ANY CLAIMS ARISING
Wolfgang Betz 90:26c0c9807ab4 29 * FROM THE CONTENT OF SUCH FIRMWARE AND/OR THE USE MADE BY CUSTOMERS OF THE
Wolfgang Betz 90:26c0c9807ab4 30 * CODING INFORMATION CONTAINED HEREIN IN CONNECTION WITH THEIR PRODUCTS.
Wolfgang Betz 90:26c0c9807ab4 31 *
Wolfgang Betz 90:26c0c9807ab4 32 * <h2><center>&copy; COPYRIGHT 2013 STMicroelectronics</center></h2>
Wolfgang Betz 91:97c0c21046b4 33 */
Wolfgang Betz 91:97c0c21046b4 34
Wolfgang Betz 90:26c0c9807ab4 35 /** @defgroup BlueNRGDevice
Wolfgang Betz 90:26c0c9807ab4 36 * @brief BlueNRG BLE_API Device Adaptation
Wolfgang Betz 90:26c0c9807ab4 37 * @{
Wolfgang Betz 90:26c0c9807ab4 38 */
Wolfgang Betz 91:97c0c21046b4 39
Wolfgang Betz 90:26c0c9807ab4 40 #include "mbed.h"
Wolfgang Betz 90:26c0c9807ab4 41 #include "BlueNRGDevice.h"
Wolfgang Betz 90:26c0c9807ab4 42 #include "BlueNRGGap.h"
Wolfgang Betz 90:26c0c9807ab4 43 #include "BlueNRGGattServer.h"
Wolfgang Betz 90:26c0c9807ab4 44
Wolfgang Betz 90:26c0c9807ab4 45 #include "btle.h"
Wolfgang Betz 90:26c0c9807ab4 46 #include "Utils.h"
Wolfgang Betz 90:26c0c9807ab4 47 #include "osal.h"
Wolfgang Betz 90:26c0c9807ab4 48
Wolfgang Betz 90:26c0c9807ab4 49 extern "C" {
Wolfgang Betz 91:97c0c21046b4 50 #include "hci.h"
Wolfgang Betz 90:26c0c9807ab4 51 }
Wolfgang Betz 90:26c0c9807ab4 52
Wolfgang Betz 90:26c0c9807ab4 53 #define HEADER_SIZE 5
Wolfgang Betz 90:26c0c9807ab4 54 #define MAX_BUFFER_SIZE 255
Wolfgang Betz 90:26c0c9807ab4 55
Wolfgang Betz 90:26c0c9807ab4 56 /**
Wolfgang Betz 90:26c0c9807ab4 57 * The singleton which represents the BlueNRG transport for the BLEDevice.
Wolfgang Betz 90:26c0c9807ab4 58 * FIXME: find a better way to create the BlueNRG device instance so that
Wolfgang Betz 90:26c0c9807ab4 59 * the pin names can be chosen by the users of this class
Wolfgang Betz 90:26c0c9807ab4 60 *
Wolfgang Betz 90:26c0c9807ab4 61 * This is using Arduino pins as follows:
Wolfgang Betz 90:26c0c9807ab4 62 * D11: MOSI line of SPI interface
Wolfgang Betz 90:26c0c9807ab4 63 * D12: MISO line of SPI interface
Wolfgang Betz 90:26c0c9807ab4 64 * D3 : SCK line of SPI interface
Wolfgang Betz 90:26c0c9807ab4 65 * A1 : nCS line of SPI interface
Wolfgang Betz 90:26c0c9807ab4 66 * D7 : BlueNRG reset
Wolfgang Betz 90:26c0c9807ab4 67 * A0 : BlueNRG IRQ pin
Wolfgang Betz 90:26c0c9807ab4 68 */
Wolfgang Betz 90:26c0c9807ab4 69 BlueNRGDevice bluenrgDeviceInstance(D11, D12, D3, A1, D7, A0);
Wolfgang Betz 90:26c0c9807ab4 70
Wolfgang Betz 90:26c0c9807ab4 71 /**
Wolfgang Betz 90:26c0c9807ab4 72 * BLE-API requires an implementation of the following function in order to
Wolfgang Betz 90:26c0c9807ab4 73 * obtain its transport handle.
Wolfgang Betz 90:26c0c9807ab4 74 */
Wolfgang Betz 90:26c0c9807ab4 75 BLEInstanceBase *
Wolfgang Betz 90:26c0c9807ab4 76 createBLEInstance(void)
Wolfgang Betz 90:26c0c9807ab4 77 {
Wolfgang Betz 90:26c0c9807ab4 78 return (&bluenrgDeviceInstance);
Wolfgang Betz 90:26c0c9807ab4 79 }
Wolfgang Betz 90:26c0c9807ab4 80
Wolfgang Betz 90:26c0c9807ab4 81 /**************************************************************************/
Wolfgang Betz 90:26c0c9807ab4 82 /**
Wolfgang Betz 90:26c0c9807ab4 83 @brief Constructor
Wolfgang Betz 90:26c0c9807ab4 84 * @param mosi mbed pin to use for MOSI line of SPI interface
Wolfgang Betz 90:26c0c9807ab4 85 * @param miso mbed pin to use for MISO line of SPI interface
Wolfgang Betz 90:26c0c9807ab4 86 * @param sck mbed pin to use for SCK line of SPI interface
Wolfgang Betz 90:26c0c9807ab4 87 * @param cs mbed pin to use for not chip select line of SPI interface
Wolfgang Betz 90:26c0c9807ab4 88 * @param rst mbed pin to use for BlueNRG reset
Wolfgang Betz 90:26c0c9807ab4 89 * @param irq mbed pin for BlueNRG IRQ
Wolfgang Betz 90:26c0c9807ab4 90 */
Wolfgang Betz 90:26c0c9807ab4 91 /**************************************************************************/
Wolfgang Betz 90:26c0c9807ab4 92 BlueNRGDevice::BlueNRGDevice(PinName mosi,
Wolfgang Betz 90:26c0c9807ab4 93 PinName miso,
Wolfgang Betz 90:26c0c9807ab4 94 PinName sck,
Wolfgang Betz 90:26c0c9807ab4 95 PinName cs,
Wolfgang Betz 90:26c0c9807ab4 96 PinName rst,
Wolfgang Betz 90:26c0c9807ab4 97 PinName irq) : spi_(mosi, miso, sck), nCS_(cs), rst_(rst), irq_(irq)
Wolfgang Betz 90:26c0c9807ab4 98 {
Wolfgang Betz 90:26c0c9807ab4 99 isInitialized = false;
Wolfgang Betz 91:97c0c21046b4 100
Wolfgang Betz 90:26c0c9807ab4 101 // Setup the spi for 8 bit data, low clock polarity,
Wolfgang Betz 90:26c0c9807ab4 102 // 1-edge phase, with an 8MHz clock rate
Wolfgang Betz 90:26c0c9807ab4 103 spi_.format(8, 0);
Wolfgang Betz 90:26c0c9807ab4 104 spi_.frequency(8000000);
Wolfgang Betz 91:97c0c21046b4 105
Wolfgang Betz 90:26c0c9807ab4 106 // Deselect the BlueNRG chip by keeping its nCS signal high
Wolfgang Betz 90:26c0c9807ab4 107 nCS_ = 1;
Wolfgang Betz 90:26c0c9807ab4 108
Wolfgang Betz 90:26c0c9807ab4 109 wait_us(500);
Wolfgang Betz 90:26c0c9807ab4 110 }
Wolfgang Betz 90:26c0c9807ab4 111
Wolfgang Betz 90:26c0c9807ab4 112 /**************************************************************************/
Wolfgang Betz 90:26c0c9807ab4 113 /**
Wolfgang Betz 90:26c0c9807ab4 114 @brief Destructor
Wolfgang Betz 90:26c0c9807ab4 115 */
Wolfgang Betz 90:26c0c9807ab4 116 /**************************************************************************/
Wolfgang Betz 90:26c0c9807ab4 117 BlueNRGDevice::~BlueNRGDevice(void)
Wolfgang Betz 90:26c0c9807ab4 118 {
Wolfgang Betz 90:26c0c9807ab4 119 }
Wolfgang Betz 90:26c0c9807ab4 120
Wolfgang Betz 90:26c0c9807ab4 121
Wolfgang Betz 90:26c0c9807ab4 122 /**
Wolfgang Betz 90:26c0c9807ab4 123 @brief Initialises anything required to start using BLE
Wolfgang Betz 90:26c0c9807ab4 124 @param[in] void
Wolfgang Betz 90:26c0c9807ab4 125 @returns ble_error_t
Wolfgang Betz 90:26c0c9807ab4 126 */
Wolfgang Betz 90:26c0c9807ab4 127 ble_error_t BlueNRGDevice::init(void)
Wolfgang Betz 90:26c0c9807ab4 128 {
Wolfgang Betz 90:26c0c9807ab4 129 // Set the interrupt handler for the device
Wolfgang Betz 90:26c0c9807ab4 130 irq_.rise(&HCI_Isr);
Wolfgang Betz 90:26c0c9807ab4 131
Wolfgang Betz 90:26c0c9807ab4 132 /* ToDo: Clear memory contents, reset the SD, etc. */
Wolfgang Betz 90:26c0c9807ab4 133 btle_init(BlueNRGGap::getInstance().getIsSetAddress());
Wolfgang Betz 91:97c0c21046b4 134
Wolfgang Betz 90:26c0c9807ab4 135 isInitialized = true;
Wolfgang Betz 90:26c0c9807ab4 136
Wolfgang Betz 90:26c0c9807ab4 137 return BLE_ERROR_NONE;
Wolfgang Betz 90:26c0c9807ab4 138 }
Wolfgang Betz 90:26c0c9807ab4 139
Wolfgang Betz 90:26c0c9807ab4 140
Wolfgang Betz 90:26c0c9807ab4 141 /**
Wolfgang Betz 90:26c0c9807ab4 142 @brief Resets the BLE HW, removing any existing services and
Wolfgang Betz 90:26c0c9807ab4 143 characteristics
Wolfgang Betz 90:26c0c9807ab4 144 @param[in] void
Wolfgang Betz 90:26c0c9807ab4 145 @returns ble_error_t
Wolfgang Betz 90:26c0c9807ab4 146 */
Wolfgang Betz 90:26c0c9807ab4 147 ble_error_t BlueNRGDevice::reset(void)
Wolfgang Betz 90:26c0c9807ab4 148 {
Wolfgang Betz 90:26c0c9807ab4 149 wait_us(500);
Wolfgang Betz 90:26c0c9807ab4 150
Wolfgang Betz 90:26c0c9807ab4 151 /* Reset BlueNRG SPI interface */
Wolfgang Betz 91:97c0c21046b4 152 rst_ = 0;
Wolfgang Betz 91:97c0c21046b4 153 wait_us(5);
Wolfgang Betz 91:97c0c21046b4 154 rst_ = 1;
Wolfgang Betz 91:97c0c21046b4 155 wait_us(5);
Wolfgang Betz 90:26c0c9807ab4 156
Wolfgang Betz 90:26c0c9807ab4 157 /* Wait for the radio to come back up */
Wolfgang Betz 90:26c0c9807ab4 158 wait_us(500);
Wolfgang Betz 90:26c0c9807ab4 159
Wolfgang Betz 90:26c0c9807ab4 160 isInitialized = false;
Wolfgang Betz 90:26c0c9807ab4 161
Wolfgang Betz 90:26c0c9807ab4 162 return BLE_ERROR_NONE;
Wolfgang Betz 90:26c0c9807ab4 163 }
Wolfgang Betz 90:26c0c9807ab4 164
Wolfgang Betz 90:26c0c9807ab4 165
Wolfgang Betz 90:26c0c9807ab4 166 /*!
Wolfgang Betz 91:97c0c21046b4 167 @brief Wait for any BLE Event like BLE Connection, Read Request etc.
Wolfgang Betz 90:26c0c9807ab4 168 @param[in] void
Wolfgang Betz 91:97c0c21046b4 169 @returns char *
Wolfgang Betz 90:26c0c9807ab4 170 */
Wolfgang Betz 90:26c0c9807ab4 171 void BlueNRGDevice::waitForEvent(void)
Wolfgang Betz 90:26c0c9807ab4 172 {
Wolfgang Betz 91:97c0c21046b4 173 bool must_return = false;
Wolfgang Betz 91:97c0c21046b4 174
Wolfgang Betz 91:97c0c21046b4 175 do {
Wolfgang Betz 91:97c0c21046b4 176 HCI_Process();
Wolfgang Betz 91:97c0c21046b4 177
Wolfgang Betz 91:97c0c21046b4 178 if(must_return) return;
Wolfgang Betz 91:97c0c21046b4 179
Wolfgang Betz 91:97c0c21046b4 180 __WFE(); /* it is recommended that SEVONPEND in the
Wolfgang Betz 91:97c0c21046b4 181 System Control Register is NOT set */
Wolfgang Betz 91:97c0c21046b4 182 must_return = true; /* after returning from WFE we must guarantee
Wolfgang Betz 91:97c0c21046b4 183 that conrol is given back to main loop before next WFE */
Wolfgang Betz 91:97c0c21046b4 184 } while(true);
Wolfgang Betz 90:26c0c9807ab4 185 }
Wolfgang Betz 90:26c0c9807ab4 186
Wolfgang Betz 90:26c0c9807ab4 187
Wolfgang Betz 90:26c0c9807ab4 188 /*!
Wolfgang Betz 90:26c0c9807ab4 189 @brief get GAP version
Wolfgang Betz 90:26c0c9807ab4 190 @param[in] void
Wolfgang Betz 90:26c0c9807ab4 191 @returns char *
Wolfgang Betz 90:26c0c9807ab4 192 */
Wolfgang Betz 90:26c0c9807ab4 193 const char *BlueNRGDevice::getVersion(void)
Wolfgang Betz 90:26c0c9807ab4 194 {
Wolfgang Betz 90:26c0c9807ab4 195 char *version = new char[6];
Wolfgang Betz 90:26c0c9807ab4 196 memcpy((void *)version, "1.0.0", 5);
Wolfgang Betz 90:26c0c9807ab4 197 return version;
Wolfgang Betz 90:26c0c9807ab4 198 }
Wolfgang Betz 90:26c0c9807ab4 199
Wolfgang Betz 90:26c0c9807ab4 200 /**************************************************************************/
Wolfgang Betz 90:26c0c9807ab4 201 /*!
Wolfgang Betz 90:26c0c9807ab4 202 @brief get init state
Wolfgang Betz 90:26c0c9807ab4 203 @param[in] void
Wolfgang Betz 91:97c0c21046b4 204 @returns bool
Wolfgang Betz 90:26c0c9807ab4 205 */
Wolfgang Betz 90:26c0c9807ab4 206 /**************************************************************************/
Wolfgang Betz 90:26c0c9807ab4 207 bool BlueNRGDevice::getIsInitialized(void)
Wolfgang Betz 90:26c0c9807ab4 208 {
Wolfgang Betz 90:26c0c9807ab4 209 return isInitialized;
Wolfgang Betz 90:26c0c9807ab4 210 }
Wolfgang Betz 90:26c0c9807ab4 211
Wolfgang Betz 90:26c0c9807ab4 212 /**************************************************************************/
Wolfgang Betz 90:26c0c9807ab4 213 /*!
Wolfgang Betz 90:26c0c9807ab4 214 @brief get reference to GAP object
Wolfgang Betz 90:26c0c9807ab4 215 @param[in] void
Wolfgang Betz 91:97c0c21046b4 216 @returns Gap&
Wolfgang Betz 90:26c0c9807ab4 217 */
Wolfgang Betz 90:26c0c9807ab4 218 /**************************************************************************/
Wolfgang Betz 90:26c0c9807ab4 219 Gap &BlueNRGDevice::getGap()
Wolfgang Betz 90:26c0c9807ab4 220 {
Wolfgang Betz 90:26c0c9807ab4 221 return BlueNRGGap::getInstance();
Wolfgang Betz 90:26c0c9807ab4 222 }
Wolfgang Betz 90:26c0c9807ab4 223
Wolfgang Betz 90:26c0c9807ab4 224 const Gap &BlueNRGDevice::getGap() const
Wolfgang Betz 90:26c0c9807ab4 225 {
Wolfgang Betz 90:26c0c9807ab4 226 return BlueNRGGap::getInstance();
Wolfgang Betz 90:26c0c9807ab4 227 }
Wolfgang Betz 90:26c0c9807ab4 228
Wolfgang Betz 90:26c0c9807ab4 229 /**************************************************************************/
Wolfgang Betz 90:26c0c9807ab4 230 /*!
Wolfgang Betz 90:26c0c9807ab4 231 @brief get reference to GATT server object
Wolfgang Betz 90:26c0c9807ab4 232 @param[in] void
Wolfgang Betz 91:97c0c21046b4 233 @returns GattServer&
Wolfgang Betz 90:26c0c9807ab4 234 */
Wolfgang Betz 90:26c0c9807ab4 235 /**************************************************************************/
Wolfgang Betz 90:26c0c9807ab4 236 GattServer &BlueNRGDevice::getGattServer()
Wolfgang Betz 90:26c0c9807ab4 237 {
Wolfgang Betz 90:26c0c9807ab4 238 return BlueNRGGattServer::getInstance();
Wolfgang Betz 90:26c0c9807ab4 239 }
Wolfgang Betz 90:26c0c9807ab4 240
Wolfgang Betz 90:26c0c9807ab4 241 const GattServer &BlueNRGDevice::getGattServer() const
Wolfgang Betz 90:26c0c9807ab4 242 {
Wolfgang Betz 90:26c0c9807ab4 243 return BlueNRGGattServer::getInstance();
Wolfgang Betz 90:26c0c9807ab4 244 }
Wolfgang Betz 90:26c0c9807ab4 245
Wolfgang Betz 90:26c0c9807ab4 246 //FIXME: TBI (by now just placeholders to let build
Wolfgang Betz 90:26c0c9807ab4 247 GattClient& BlueNRGDevice::getGattClient() {}
Wolfgang Betz 90:26c0c9807ab4 248 SecurityManager& BlueNRGDevice::getSecurityManager(){}
Wolfgang Betz 90:26c0c9807ab4 249 const SecurityManager& BlueNRGDevice::getSecurityManager() const {}
Wolfgang Betz 91:97c0c21046b4 250
Wolfgang Betz 90:26c0c9807ab4 251 /**************************************************************************/
Wolfgang Betz 90:26c0c9807ab4 252 /*!
Wolfgang Betz 90:26c0c9807ab4 253 @brief shut down the the BLE device
Wolfgang Betz 90:26c0c9807ab4 254 @param[out] error if any
Wolfgang Betz 90:26c0c9807ab4 255 */
Wolfgang Betz 90:26c0c9807ab4 256 /**************************************************************************/
Wolfgang Betz 90:26c0c9807ab4 257 ble_error_t BlueNRGDevice::shutdown(void) {
Wolfgang Betz 90:26c0c9807ab4 258 return reset();
Wolfgang Betz 90:26c0c9807ab4 259 }
Wolfgang Betz 91:97c0c21046b4 260
Wolfgang Betz 90:26c0c9807ab4 261 /**
Wolfgang Betz 90:26c0c9807ab4 262 * @brief Reads from BlueNRG SPI buffer and store data into local buffer.
Wolfgang Betz 90:26c0c9807ab4 263 * @param buffer : Buffer where data from SPI are stored
Wolfgang Betz 90:26c0c9807ab4 264 * @param buff_size: Buffer size
Wolfgang Betz 90:26c0c9807ab4 265 * @retval int32_t : Number of read bytes
Wolfgang Betz 90:26c0c9807ab4 266 */
Wolfgang Betz 90:26c0c9807ab4 267 int32_t BlueNRGDevice::spiRead(uint8_t *buffer, uint8_t buff_size)
Wolfgang Betz 90:26c0c9807ab4 268 {
Wolfgang Betz 91:97c0c21046b4 269 uint16_t byte_count;
Wolfgang Betz 91:97c0c21046b4 270 uint8_t len = 0;
Wolfgang Betz 91:97c0c21046b4 271 uint8_t char_ff = 0xff;
Wolfgang Betz 91:97c0c21046b4 272 volatile uint8_t read_char;
Wolfgang Betz 91:97c0c21046b4 273
Wolfgang Betz 91:97c0c21046b4 274 uint8_t i = 0;
Wolfgang Betz 91:97c0c21046b4 275 volatile uint8_t tmpreg;
Wolfgang Betz 91:97c0c21046b4 276
Wolfgang Betz 91:97c0c21046b4 277 uint8_t header_master[HEADER_SIZE] = {0x0b, 0x00, 0x00, 0x00, 0x00};
Wolfgang Betz 91:97c0c21046b4 278 uint8_t header_slave[HEADER_SIZE];
Wolfgang Betz 90:26c0c9807ab4 279
Wolfgang Betz 91:97c0c21046b4 280 /* Select the chip */
Wolfgang Betz 91:97c0c21046b4 281 nCS_ = 0;
Wolfgang Betz 91:97c0c21046b4 282
Wolfgang Betz 91:97c0c21046b4 283 /* Read the header */
Wolfgang Betz 91:97c0c21046b4 284 for (i = 0; i < 5; i++)
Wolfgang Betz 91:97c0c21046b4 285 {
Wolfgang Betz 91:97c0c21046b4 286 tmpreg = spi_.write(header_master[i]);
Wolfgang Betz 91:97c0c21046b4 287 header_slave[i] = (uint8_t)(tmpreg);
Wolfgang Betz 91:97c0c21046b4 288 }
Wolfgang Betz 91:97c0c21046b4 289
Wolfgang Betz 91:97c0c21046b4 290 if (header_slave[0] == 0x02) {
Wolfgang Betz 91:97c0c21046b4 291 /* device is ready */
Wolfgang Betz 91:97c0c21046b4 292 byte_count = (header_slave[4]<<8)|header_slave[3];
Wolfgang Betz 91:97c0c21046b4 293
Wolfgang Betz 91:97c0c21046b4 294 if (byte_count > 0) {
Wolfgang Betz 90:26c0c9807ab4 295
Wolfgang Betz 91:97c0c21046b4 296 /* avoid to read more data that size of the buffer */
Wolfgang Betz 91:97c0c21046b4 297 if (byte_count > buff_size){
Wolfgang Betz 91:97c0c21046b4 298 byte_count = buff_size;
Wolfgang Betz 91:97c0c21046b4 299 }
Wolfgang Betz 91:97c0c21046b4 300
Wolfgang Betz 91:97c0c21046b4 301 for (len = 0; len < byte_count; len++){
Wolfgang Betz 91:97c0c21046b4 302 read_char = spi_.write(char_ff);
Wolfgang Betz 91:97c0c21046b4 303 buffer[len] = read_char;
Wolfgang Betz 91:97c0c21046b4 304 }
Wolfgang Betz 91:97c0c21046b4 305 }
Wolfgang Betz 91:97c0c21046b4 306 }
Wolfgang Betz 91:97c0c21046b4 307 /* Release CS line to deselect the chip */
Wolfgang Betz 91:97c0c21046b4 308 nCS_ = 1;
Wolfgang Betz 91:97c0c21046b4 309
Wolfgang Betz 91:97c0c21046b4 310 // Add a small delay to give time to the BlueNRG to set the IRQ pin low
Wolfgang Betz 91:97c0c21046b4 311 // to avoid a useless SPI read at the end of the transaction
Wolfgang Betz 91:97c0c21046b4 312 for(volatile int i = 0; i < 2; i++)__NOP();
Wolfgang Betz 91:97c0c21046b4 313
Wolfgang Betz 90:26c0c9807ab4 314 #ifdef PRINT_CSV_FORMAT
Wolfgang Betz 91:97c0c21046b4 315 if (len > 0) {
Wolfgang Betz 91:97c0c21046b4 316 // print_csv_time();
Wolfgang Betz 91:97c0c21046b4 317 for (int i=0; i<len; i++) {
Wolfgang Betz 91:97c0c21046b4 318 PRINT_CSV(" %02x", buffer[i]);
Wolfgang Betz 91:97c0c21046b4 319 }
Wolfgang Betz 91:97c0c21046b4 320 PRINT_CSV("\n");
Wolfgang Betz 90:26c0c9807ab4 321 }
Wolfgang Betz 90:26c0c9807ab4 322 #endif
Wolfgang Betz 91:97c0c21046b4 323
Wolfgang Betz 91:97c0c21046b4 324 return len;
Wolfgang Betz 90:26c0c9807ab4 325 }
Wolfgang Betz 90:26c0c9807ab4 326
Wolfgang Betz 90:26c0c9807ab4 327 /**
Wolfgang Betz 90:26c0c9807ab4 328 * @brief Writes data from local buffer to SPI.
Wolfgang Betz 90:26c0c9807ab4 329 * @param data1 : First data buffer to be written
Wolfgang Betz 90:26c0c9807ab4 330 * @param data2 : Second data buffer to be written
Wolfgang Betz 90:26c0c9807ab4 331 * @param Nb_bytes1: Size of first data buffer to be written
Wolfgang Betz 90:26c0c9807ab4 332 * @param Nb_bytes2: Size of second data buffer to be written
Wolfgang Betz 90:26c0c9807ab4 333 * @retval Number of read bytes
Wolfgang Betz 90:26c0c9807ab4 334 */
Wolfgang Betz 90:26c0c9807ab4 335 int32_t BlueNRGDevice::spiWrite(uint8_t* data1,
Wolfgang Betz 91:97c0c21046b4 336 uint8_t* data2, uint8_t Nb_bytes1, uint8_t Nb_bytes2)
Wolfgang Betz 90:26c0c9807ab4 337 {
Wolfgang Betz 91:97c0c21046b4 338 int32_t result = 0;
Wolfgang Betz 91:97c0c21046b4 339
Wolfgang Betz 91:97c0c21046b4 340 uint32_t i;
Wolfgang Betz 91:97c0c21046b4 341 volatile uint8_t read_char;
Wolfgang Betz 91:97c0c21046b4 342 volatile uint8_t tmpreg;
Wolfgang Betz 90:26c0c9807ab4 343
Wolfgang Betz 91:97c0c21046b4 344 unsigned char header_master[HEADER_SIZE] = {0x0a, 0x00, 0x00, 0x00, 0x00};
Wolfgang Betz 91:97c0c21046b4 345 unsigned char header_slave[HEADER_SIZE] = {0xaa, 0x00, 0x00, 0x00, 0x00};
Wolfgang Betz 91:97c0c21046b4 346
Wolfgang Betz 91:97c0c21046b4 347 //unsigned char read_char_buf[MAX_BUFFER_SIZE];
Wolfgang Betz 91:97c0c21046b4 348
Wolfgang Betz 91:97c0c21046b4 349 disable_irq();
Wolfgang Betz 90:26c0c9807ab4 350
Wolfgang Betz 91:97c0c21046b4 351 /* CS reset */
Wolfgang Betz 91:97c0c21046b4 352 nCS_ = 0;
Wolfgang Betz 90:26c0c9807ab4 353
Wolfgang Betz 91:97c0c21046b4 354 /* Exchange header */
Wolfgang Betz 91:97c0c21046b4 355 for (i = 0; i < 5; i++)
Wolfgang Betz 91:97c0c21046b4 356 {
Wolfgang Betz 91:97c0c21046b4 357 tmpreg = spi_.write(header_master[i]);
Wolfgang Betz 91:97c0c21046b4 358 header_slave[i] = tmpreg;
Wolfgang Betz 91:97c0c21046b4 359 }
Wolfgang Betz 90:26c0c9807ab4 360
Wolfgang Betz 91:97c0c21046b4 361 if (header_slave[0] == 0x02) {
Wolfgang Betz 91:97c0c21046b4 362 /* SPI is ready */
Wolfgang Betz 91:97c0c21046b4 363 if (header_slave[1] >= (Nb_bytes1+Nb_bytes2)) {
Wolfgang Betz 91:97c0c21046b4 364
Wolfgang Betz 91:97c0c21046b4 365 /* Buffer is big enough */
Wolfgang Betz 91:97c0c21046b4 366 for (i = 0; i < Nb_bytes1; i++) {
Wolfgang Betz 91:97c0c21046b4 367 read_char = spi_.write(*(data1 + i));
Wolfgang Betz 91:97c0c21046b4 368 }
Wolfgang Betz 91:97c0c21046b4 369 for (i = 0; i < Nb_bytes2; i++) {
Wolfgang Betz 91:97c0c21046b4 370 read_char = spi_.write(*(data2 + i));
Wolfgang Betz 91:97c0c21046b4 371 }
Wolfgang Betz 91:97c0c21046b4 372 } else {
Wolfgang Betz 91:97c0c21046b4 373 /* Buffer is too small */
Wolfgang Betz 91:97c0c21046b4 374 result = -2;
Wolfgang Betz 91:97c0c21046b4 375 }
Wolfgang Betz 90:26c0c9807ab4 376 } else {
Wolfgang Betz 91:97c0c21046b4 377 /* SPI is not ready */
Wolfgang Betz 91:97c0c21046b4 378 result = -1;
Wolfgang Betz 90:26c0c9807ab4 379 }
Wolfgang Betz 90:26c0c9807ab4 380
Wolfgang Betz 91:97c0c21046b4 381 /* Release CS line */
Wolfgang Betz 91:97c0c21046b4 382 //HAL_GPIO_WritePin(BNRG_SPI_CS_PORT, BNRG_SPI_CS_PIN, GPIO_PIN_SET);
Wolfgang Betz 91:97c0c21046b4 383 nCS_ = 1;
Wolfgang Betz 91:97c0c21046b4 384
Wolfgang Betz 91:97c0c21046b4 385 enable_irq();
Wolfgang Betz 90:26c0c9807ab4 386
Wolfgang Betz 91:97c0c21046b4 387 return result;
Wolfgang Betz 90:26c0c9807ab4 388 }
Wolfgang Betz 90:26c0c9807ab4 389
Wolfgang Betz 90:26c0c9807ab4 390 bool BlueNRGDevice::dataPresent()
Wolfgang Betz 90:26c0c9807ab4 391 {
Wolfgang Betz 90:26c0c9807ab4 392 return (irq_ == 1);
Wolfgang Betz 90:26c0c9807ab4 393 }
Wolfgang Betz 90:26c0c9807ab4 394
Wolfgang Betz 90:26c0c9807ab4 395 void BlueNRGDevice::disable_irq()
Wolfgang Betz 90:26c0c9807ab4 396 {
Wolfgang Betz 90:26c0c9807ab4 397 irq_.disable_irq();
Wolfgang Betz 90:26c0c9807ab4 398 }
Wolfgang Betz 90:26c0c9807ab4 399
Wolfgang Betz 90:26c0c9807ab4 400 void BlueNRGDevice::enable_irq()
Wolfgang Betz 90:26c0c9807ab4 401 {
Wolfgang Betz 90:26c0c9807ab4 402 irq_.enable_irq();
Wolfgang Betz 90:26c0c9807ab4 403 }