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@115:3b47df81a56b, 2015-09-02 (annotated)

Committer:
Wolfgang Betz
Date:
Wed Sep 02 07:50:35 2015 +0200
Revision:
115:3b47df81a56b
Parent:
113:31c73e9b0108
Child:
116:1aa0d2da72e4
Merge commit '05e0fdbf467718fa524cc667f5c9f85228096655' into ble_wb

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 115:3b47df81a56b 16
Wolfgang Betz 90:26c0c9807ab4 17 /**
Wolfgang Betz 90:26c0c9807ab4 18 ******************************************************************************
Wolfgang Betz 115:3b47df81a56b 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 115:3b47df81a56b 33 */
Wolfgang Betz 115:3b47df81a56b 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 115:3b47df81a56b 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 115:3b47df81a56b 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 115:3b47df81a56b 48
Wolfgang Betz 115:3b47df81a56b 49 #include "debug.h"
Wolfgang Betz 115:3b47df81a56b 50 #include "stm32_bluenrg_ble.h"
Wolfgang Betz 115:3b47df81a56b 51
Wolfgang Betz 90:26c0c9807ab4 52 extern "C" {
Wolfgang Betz 115:3b47df81a56b 53 #include "hci.h"
Wolfgang Betz 90:26c0c9807ab4 54 }
Wolfgang Betz 115:3b47df81a56b 55
Wolfgang Betz 90:26c0c9807ab4 56 #define HEADER_SIZE 5
Wolfgang Betz 90:26c0c9807ab4 57 #define MAX_BUFFER_SIZE 255
Wolfgang Betz 115:3b47df81a56b 58
Wolfgang Betz 90:26c0c9807ab4 59 /**
Wolfgang Betz 90:26c0c9807ab4 60 * The singleton which represents the BlueNRG transport for the BLEDevice.
Wolfgang Betz 90:26c0c9807ab4 61 *
Wolfgang Betz 113:31c73e9b0108 62 * See file 'x_nucleo_idb0xa1_targets.h' for details regarding the peripheral pins used!
Wolfgang Betz 90:26c0c9807ab4 63 */
Wolfgang Betz 113:31c73e9b0108 64 #include "x_nucleo_idb0xa1_targets.h"
Wolfgang Betz 113:31c73e9b0108 65
Wolfgang Betz 113:31c73e9b0108 66 BlueNRGDevice bluenrgDeviceInstance(IDB0XA1_PIN_SPI_MOSI,
Wolfgang Betz 113:31c73e9b0108 67 IDB0XA1_PIN_SPI_MISO,
Wolfgang Betz 113:31c73e9b0108 68 IDB0XA1_PIN_SPI_SCK,
Wolfgang Betz 113:31c73e9b0108 69 IDB0XA1_PIN_SPI_nCS,
Wolfgang Betz 113:31c73e9b0108 70 IDB0XA1_PIN_SPI_RESET,
Wolfgang Betz 113:31c73e9b0108 71 IDB0XA1_PIN_SPI_IRQ);
Wolfgang Betz 90:26c0c9807ab4 72
Wolfgang Betz 90:26c0c9807ab4 73 /**
Wolfgang Betz 90:26c0c9807ab4 74 * BLE-API requires an implementation of the following function in order to
Wolfgang Betz 90:26c0c9807ab4 75 * obtain its transport handle.
Wolfgang Betz 90:26c0c9807ab4 76 */
Wolfgang Betz 90:26c0c9807ab4 77 BLEInstanceBase *
Wolfgang Betz 90:26c0c9807ab4 78 createBLEInstance(void)
Wolfgang Betz 90:26c0c9807ab4 79 {
Wolfgang Betz 90:26c0c9807ab4 80 return (&bluenrgDeviceInstance);
Wolfgang Betz 90:26c0c9807ab4 81 }
Wolfgang Betz 115:3b47df81a56b 82
Wolfgang Betz 90:26c0c9807ab4 83 /**************************************************************************/
Wolfgang Betz 90:26c0c9807ab4 84 /**
Wolfgang Betz 90:26c0c9807ab4 85 @brief Constructor
Wolfgang Betz 90:26c0c9807ab4 86 * @param mosi mbed pin to use for MOSI line of SPI interface
Wolfgang Betz 90:26c0c9807ab4 87 * @param miso mbed pin to use for MISO line of SPI interface
Wolfgang Betz 90:26c0c9807ab4 88 * @param sck mbed pin to use for SCK line of SPI interface
Wolfgang Betz 90:26c0c9807ab4 89 * @param cs mbed pin to use for not chip select line of SPI interface
Wolfgang Betz 90:26c0c9807ab4 90 * @param rst mbed pin to use for BlueNRG reset
Wolfgang Betz 90:26c0c9807ab4 91 * @param irq mbed pin for BlueNRG IRQ
Wolfgang Betz 90:26c0c9807ab4 92 */
Wolfgang Betz 90:26c0c9807ab4 93 /**************************************************************************/
Wolfgang Betz 90:26c0c9807ab4 94 BlueNRGDevice::BlueNRGDevice(PinName mosi,
Wolfgang Betz 90:26c0c9807ab4 95 PinName miso,
Wolfgang Betz 90:26c0c9807ab4 96 PinName sck,
Wolfgang Betz 90:26c0c9807ab4 97 PinName cs,
Wolfgang Betz 90:26c0c9807ab4 98 PinName rst,
Wolfgang Betz 90:26c0c9807ab4 99 PinName irq) : spi_(mosi, miso, sck), nCS_(cs), rst_(rst), irq_(irq)
Wolfgang Betz 90:26c0c9807ab4 100 {
Wolfgang Betz 90:26c0c9807ab4 101 isInitialized = false;
Wolfgang Betz 115:3b47df81a56b 102
Wolfgang Betz 90:26c0c9807ab4 103 // Setup the spi for 8 bit data, low clock polarity,
Wolfgang Betz 90:26c0c9807ab4 104 // 1-edge phase, with an 8MHz clock rate
Wolfgang Betz 90:26c0c9807ab4 105 spi_.format(8, 0);
Wolfgang Betz 90:26c0c9807ab4 106 spi_.frequency(8000000);
Wolfgang Betz 115:3b47df81a56b 107
Wolfgang Betz 90:26c0c9807ab4 108 // Deselect the BlueNRG chip by keeping its nCS signal high
Wolfgang Betz 90:26c0c9807ab4 109 nCS_ = 1;
Wolfgang Betz 115:3b47df81a56b 110
Wolfgang Betz 90:26c0c9807ab4 111 wait_us(500);
Wolfgang Betz 90:26c0c9807ab4 112 }
Wolfgang Betz 115:3b47df81a56b 113
Wolfgang Betz 90:26c0c9807ab4 114 /**************************************************************************/
Wolfgang Betz 90:26c0c9807ab4 115 /**
Wolfgang Betz 90:26c0c9807ab4 116 @brief Destructor
Wolfgang Betz 90:26c0c9807ab4 117 */
Wolfgang Betz 90:26c0c9807ab4 118 /**************************************************************************/
Wolfgang Betz 90:26c0c9807ab4 119 BlueNRGDevice::~BlueNRGDevice(void)
Wolfgang Betz 90:26c0c9807ab4 120 {
Wolfgang Betz 90:26c0c9807ab4 121 }
Wolfgang Betz 115:3b47df81a56b 122
Wolfgang Betz 115:3b47df81a56b 123
Wolfgang Betz 90:26c0c9807ab4 124 /**
Wolfgang Betz 90:26c0c9807ab4 125 @brief Initialises anything required to start using BLE
Wolfgang Betz 90:26c0c9807ab4 126 @param[in] void
Wolfgang Betz 90:26c0c9807ab4 127 @returns ble_error_t
Wolfgang Betz 90:26c0c9807ab4 128 */
Wolfgang Betz 90:26c0c9807ab4 129 ble_error_t BlueNRGDevice::init(void)
Wolfgang Betz 90:26c0c9807ab4 130 {
Wolfgang Betz 90:26c0c9807ab4 131 // Set the interrupt handler for the device
Wolfgang Betz 113:31c73e9b0108 132 irq_.mode(PullNone); // betzw: set irq mode
Wolfgang Betz 90:26c0c9807ab4 133 irq_.rise(&HCI_Isr);
Wolfgang Betz 115:3b47df81a56b 134
Wolfgang Betz 90:26c0c9807ab4 135 /* ToDo: Clear memory contents, reset the SD, etc. */
Wolfgang Betz 90:26c0c9807ab4 136 btle_init(BlueNRGGap::getInstance().getIsSetAddress());
Wolfgang Betz 115:3b47df81a56b 137
Wolfgang Betz 90:26c0c9807ab4 138 isInitialized = true;
Wolfgang Betz 90:26c0c9807ab4 139
Wolfgang Betz 90:26c0c9807ab4 140 return BLE_ERROR_NONE;
Wolfgang Betz 90:26c0c9807ab4 141 }
Wolfgang Betz 115:3b47df81a56b 142
Wolfgang Betz 115:3b47df81a56b 143
Wolfgang Betz 90:26c0c9807ab4 144 /**
Wolfgang Betz 90:26c0c9807ab4 145 @brief Resets the BLE HW, removing any existing services and
Wolfgang Betz 90:26c0c9807ab4 146 characteristics
Wolfgang Betz 90:26c0c9807ab4 147 @param[in] void
Wolfgang Betz 90:26c0c9807ab4 148 @returns ble_error_t
Wolfgang Betz 90:26c0c9807ab4 149 */
Wolfgang Betz 90:26c0c9807ab4 150 ble_error_t BlueNRGDevice::reset(void)
Wolfgang Betz 90:26c0c9807ab4 151 {
Wolfgang Betz 90:26c0c9807ab4 152 wait_us(500);
Wolfgang Betz 115:3b47df81a56b 153
Wolfgang Betz 90:26c0c9807ab4 154 /* Reset BlueNRG SPI interface */
Wolfgang Betz 115:3b47df81a56b 155 rst_ = 0;
Wolfgang Betz 103:12684d94c3a6 156 wait_us(5);
Wolfgang Betz 115:3b47df81a56b 157 rst_ = 1;
Wolfgang Betz 103:12684d94c3a6 158 wait_us(5);
Wolfgang Betz 115:3b47df81a56b 159
Wolfgang Betz 90:26c0c9807ab4 160 /* Wait for the radio to come back up */
Wolfgang Betz 90:26c0c9807ab4 161 wait_us(500);
Wolfgang Betz 90:26c0c9807ab4 162
Wolfgang Betz 90:26c0c9807ab4 163 isInitialized = false;
Wolfgang Betz 115:3b47df81a56b 164
Wolfgang Betz 90:26c0c9807ab4 165 return BLE_ERROR_NONE;
Wolfgang Betz 90:26c0c9807ab4 166 }
Wolfgang Betz 115:3b47df81a56b 167
Wolfgang Betz 115:3b47df81a56b 168
Wolfgang Betz 90:26c0c9807ab4 169 /*!
Wolfgang Betz 115:3b47df81a56b 170 @brief Wait for any BLE Event like BLE Connection, Read Request etc.
Wolfgang Betz 90:26c0c9807ab4 171 @param[in] void
Wolfgang Betz 115:3b47df81a56b 172 @returns char *
Wolfgang Betz 90:26c0c9807ab4 173 */
Wolfgang Betz 90:26c0c9807ab4 174 void BlueNRGDevice::waitForEvent(void)
Wolfgang Betz 90:26c0c9807ab4 175 {
Wolfgang Betz 103:12684d94c3a6 176 bool must_return = false;
Wolfgang Betz 103:12684d94c3a6 177
Wolfgang Betz 103:12684d94c3a6 178 do {
Wolfgang Betz 103:12684d94c3a6 179 HCI_Process();
Wolfgang Betz 103:12684d94c3a6 180
Wolfgang Betz 103:12684d94c3a6 181 if(must_return) return;
Wolfgang Betz 103:12684d94c3a6 182
Wolfgang Betz 103:12684d94c3a6 183 __WFE(); /* it is recommended that SEVONPEND in the
Wolfgang Betz 103:12684d94c3a6 184 System Control Register is NOT set */
Wolfgang Betz 103:12684d94c3a6 185 must_return = true; /* after returning from WFE we must guarantee
Wolfgang Betz 103:12684d94c3a6 186 that conrol is given back to main loop before next WFE */
Wolfgang Betz 103:12684d94c3a6 187 } while(true);
Wolfgang Betz 90:26c0c9807ab4 188 }
Wolfgang Betz 115:3b47df81a56b 189
Wolfgang Betz 115:3b47df81a56b 190
Wolfgang Betz 90:26c0c9807ab4 191 /*!
Wolfgang Betz 90:26c0c9807ab4 192 @brief get GAP version
Wolfgang Betz 90:26c0c9807ab4 193 @param[in] void
Wolfgang Betz 90:26c0c9807ab4 194 @returns char *
Wolfgang Betz 90:26c0c9807ab4 195 */
Wolfgang Betz 90:26c0c9807ab4 196 const char *BlueNRGDevice::getVersion(void)
Wolfgang Betz 90:26c0c9807ab4 197 {
Wolfgang Betz 90:26c0c9807ab4 198 char *version = new char[6];
Wolfgang Betz 90:26c0c9807ab4 199 memcpy((void *)version, "1.0.0", 5);
Wolfgang Betz 90:26c0c9807ab4 200 return version;
Wolfgang Betz 90:26c0c9807ab4 201 }
Wolfgang Betz 115:3b47df81a56b 202
Wolfgang Betz 90:26c0c9807ab4 203 /**************************************************************************/
Wolfgang Betz 90:26c0c9807ab4 204 /*!
Wolfgang Betz 90:26c0c9807ab4 205 @brief get init state
Wolfgang Betz 90:26c0c9807ab4 206 @param[in] void
Wolfgang Betz 115:3b47df81a56b 207 @returns bool
Wolfgang Betz 90:26c0c9807ab4 208 */
Wolfgang Betz 90:26c0c9807ab4 209 /**************************************************************************/
Wolfgang Betz 90:26c0c9807ab4 210 bool BlueNRGDevice::getIsInitialized(void)
Wolfgang Betz 90:26c0c9807ab4 211 {
Wolfgang Betz 90:26c0c9807ab4 212 return isInitialized;
Wolfgang Betz 90:26c0c9807ab4 213 }
Wolfgang Betz 115:3b47df81a56b 214
Wolfgang Betz 90:26c0c9807ab4 215 /**************************************************************************/
Wolfgang Betz 90:26c0c9807ab4 216 /*!
Wolfgang Betz 90:26c0c9807ab4 217 @brief get reference to GAP object
Wolfgang Betz 90:26c0c9807ab4 218 @param[in] void
Wolfgang Betz 115:3b47df81a56b 219 @returns Gap&
Wolfgang Betz 90:26c0c9807ab4 220 */
Wolfgang Betz 90:26c0c9807ab4 221 /**************************************************************************/
Wolfgang Betz 90:26c0c9807ab4 222 Gap &BlueNRGDevice::getGap()
Wolfgang Betz 90:26c0c9807ab4 223 {
Wolfgang Betz 90:26c0c9807ab4 224 return BlueNRGGap::getInstance();
Wolfgang Betz 90:26c0c9807ab4 225 }
Wolfgang Betz 115:3b47df81a56b 226
Wolfgang Betz 90:26c0c9807ab4 227 const Gap &BlueNRGDevice::getGap() const
Wolfgang Betz 90:26c0c9807ab4 228 {
Wolfgang Betz 90:26c0c9807ab4 229 return BlueNRGGap::getInstance();
Wolfgang Betz 90:26c0c9807ab4 230 }
Wolfgang Betz 115:3b47df81a56b 231
Wolfgang Betz 90:26c0c9807ab4 232 /**************************************************************************/
Wolfgang Betz 90:26c0c9807ab4 233 /*!
Wolfgang Betz 90:26c0c9807ab4 234 @brief get reference to GATT server object
Wolfgang Betz 90:26c0c9807ab4 235 @param[in] void
Wolfgang Betz 115:3b47df81a56b 236 @returns GattServer&
Wolfgang Betz 90:26c0c9807ab4 237 */
Wolfgang Betz 90:26c0c9807ab4 238 /**************************************************************************/
Wolfgang Betz 90:26c0c9807ab4 239 GattServer &BlueNRGDevice::getGattServer()
Wolfgang Betz 90:26c0c9807ab4 240 {
Wolfgang Betz 90:26c0c9807ab4 241 return BlueNRGGattServer::getInstance();
Wolfgang Betz 90:26c0c9807ab4 242 }
Wolfgang Betz 115:3b47df81a56b 243
Wolfgang Betz 90:26c0c9807ab4 244 const GattServer &BlueNRGDevice::getGattServer() const
Wolfgang Betz 90:26c0c9807ab4 245 {
Wolfgang Betz 90:26c0c9807ab4 246 return BlueNRGGattServer::getInstance();
Wolfgang Betz 90:26c0c9807ab4 247 }
Wolfgang Betz 90:26c0c9807ab4 248
Wolfgang Betz 90:26c0c9807ab4 249 /**************************************************************************/
Wolfgang Betz 90:26c0c9807ab4 250 /*!
Wolfgang Betz 90:26c0c9807ab4 251 @brief shut down the the BLE device
Wolfgang Betz 90:26c0c9807ab4 252 @param[out] error if any
Wolfgang Betz 90:26c0c9807ab4 253 */
Wolfgang Betz 90:26c0c9807ab4 254 /**************************************************************************/
Wolfgang Betz 90:26c0c9807ab4 255 ble_error_t BlueNRGDevice::shutdown(void) {
Wolfgang Betz 90:26c0c9807ab4 256 return reset();
Wolfgang Betz 90:26c0c9807ab4 257 }
Wolfgang Betz 115:3b47df81a56b 258
Wolfgang Betz 90:26c0c9807ab4 259 /**
Wolfgang Betz 90:26c0c9807ab4 260 * @brief Reads from BlueNRG SPI buffer and store data into local buffer.
Wolfgang Betz 90:26c0c9807ab4 261 * @param buffer : Buffer where data from SPI are stored
Wolfgang Betz 90:26c0c9807ab4 262 * @param buff_size: Buffer size
Wolfgang Betz 90:26c0c9807ab4 263 * @retval int32_t : Number of read bytes
Wolfgang Betz 90:26c0c9807ab4 264 */
Wolfgang Betz 90:26c0c9807ab4 265 int32_t BlueNRGDevice::spiRead(uint8_t *buffer, uint8_t buff_size)
Wolfgang Betz 90:26c0c9807ab4 266 {
Wolfgang Betz 115:3b47df81a56b 267 uint16_t byte_count;
Wolfgang Betz 115:3b47df81a56b 268 uint8_t len = 0;
Wolfgang Betz 115:3b47df81a56b 269 uint8_t char_ff = 0xff;
Wolfgang Betz 115:3b47df81a56b 270 volatile uint8_t read_char;
Wolfgang Betz 115:3b47df81a56b 271
Wolfgang Betz 103:12684d94c3a6 272 uint8_t i = 0;
Wolfgang Betz 103:12684d94c3a6 273 volatile uint8_t tmpreg;
Wolfgang Betz 115:3b47df81a56b 274
Wolfgang Betz 115:3b47df81a56b 275 uint8_t header_master[HEADER_SIZE] = {0x0b, 0x00, 0x00, 0x00, 0x00};
Wolfgang Betz 115:3b47df81a56b 276 uint8_t header_slave[HEADER_SIZE];
Wolfgang Betz 115:3b47df81a56b 277
Wolfgang Betz 115:3b47df81a56b 278 /* Select the chip */
Wolfgang Betz 115:3b47df81a56b 279 nCS_ = 0;
Wolfgang Betz 115:3b47df81a56b 280
Wolfgang Betz 115:3b47df81a56b 281 /* Read the header */
Wolfgang Betz 115:3b47df81a56b 282 for (i = 0; i < 5; i++)
Wolfgang Betz 115:3b47df81a56b 283 {
Wolfgang Betz 103:12684d94c3a6 284 tmpreg = spi_.write(header_master[i]);
Wolfgang Betz 103:12684d94c3a6 285 header_slave[i] = (uint8_t)(tmpreg);
Wolfgang Betz 115:3b47df81a56b 286 }
Wolfgang Betz 115:3b47df81a56b 287
Wolfgang Betz 115:3b47df81a56b 288 if (header_slave[0] == 0x02) {
Wolfgang Betz 115:3b47df81a56b 289 /* device is ready */
Wolfgang Betz 115:3b47df81a56b 290 byte_count = (header_slave[4]<<8)|header_slave[3];
Wolfgang Betz 115:3b47df81a56b 291
Wolfgang Betz 115:3b47df81a56b 292 if (byte_count > 0) {
Wolfgang Betz 115:3b47df81a56b 293
Wolfgang Betz 115:3b47df81a56b 294 /* avoid to read more data that size of the buffer */
Wolfgang Betz 115:3b47df81a56b 295 if (byte_count > buff_size){
Wolfgang Betz 115:3b47df81a56b 296 byte_count = buff_size;
Wolfgang Betz 115:3b47df81a56b 297 }
Wolfgang Betz 115:3b47df81a56b 298
Wolfgang Betz 115:3b47df81a56b 299 for (len = 0; len < byte_count; len++){
Wolfgang Betz 115:3b47df81a56b 300 read_char = spi_.write(char_ff);
Wolfgang Betz 103:12684d94c3a6 301 buffer[len] = read_char;
Wolfgang Betz 115:3b47df81a56b 302 }
Wolfgang Betz 115:3b47df81a56b 303 }
Wolfgang Betz 115:3b47df81a56b 304 }
Wolfgang Betz 115:3b47df81a56b 305 /* Release CS line to deselect the chip */
Wolfgang Betz 115:3b47df81a56b 306 nCS_ = 1;
Wolfgang Betz 115:3b47df81a56b 307
Wolfgang Betz 115:3b47df81a56b 308 // Add a small delay to give time to the BlueNRG to set the IRQ pin low
Wolfgang Betz 115:3b47df81a56b 309 // to avoid a useless SPI read at the end of the transaction
Wolfgang Betz 115:3b47df81a56b 310 for(volatile int i = 0; i < 2; i++)__NOP();
Wolfgang Betz 115:3b47df81a56b 311
Wolfgang Betz 115:3b47df81a56b 312 #ifdef PRINT_CSV_FORMAT
Wolfgang Betz 115:3b47df81a56b 313 if (len > 0) {
Wolfgang Betz 115:3b47df81a56b 314 print_csv_time();
Wolfgang Betz 115:3b47df81a56b 315 for (int i=0; i<len; i++) {
Wolfgang Betz 115:3b47df81a56b 316 PRINT_CSV(" %02x", buffer[i]);
Wolfgang Betz 103:12684d94c3a6 317 }
Wolfgang Betz 115:3b47df81a56b 318 PRINT_CSV("\n");
Wolfgang Betz 115:3b47df81a56b 319 }
Wolfgang Betz 90:26c0c9807ab4 320 #endif
Wolfgang Betz 115:3b47df81a56b 321
Wolfgang Betz 115:3b47df81a56b 322 return len;
Wolfgang Betz 90:26c0c9807ab4 323 }
Wolfgang Betz 115:3b47df81a56b 324
Wolfgang Betz 90:26c0c9807ab4 325 /**
Wolfgang Betz 90:26c0c9807ab4 326 * @brief Writes data from local buffer to SPI.
Wolfgang Betz 90:26c0c9807ab4 327 * @param data1 : First data buffer to be written
Wolfgang Betz 90:26c0c9807ab4 328 * @param data2 : Second data buffer to be written
Wolfgang Betz 90:26c0c9807ab4 329 * @param Nb_bytes1: Size of first data buffer to be written
Wolfgang Betz 90:26c0c9807ab4 330 * @param Nb_bytes2: Size of second data buffer to be written
Wolfgang Betz 90:26c0c9807ab4 331 * @retval Number of read bytes
Wolfgang Betz 90:26c0c9807ab4 332 */
Wolfgang Betz 90:26c0c9807ab4 333 int32_t BlueNRGDevice::spiWrite(uint8_t* data1,
Wolfgang Betz 115:3b47df81a56b 334 uint8_t* data2, uint8_t Nb_bytes1, uint8_t Nb_bytes2)
Wolfgang Betz 90:26c0c9807ab4 335 {
Wolfgang Betz 115:3b47df81a56b 336 int32_t result = 0;
Wolfgang Betz 115:3b47df81a56b 337
Wolfgang Betz 103:12684d94c3a6 338 uint32_t i;
Wolfgang Betz 115:3b47df81a56b 339 volatile uint8_t read_char;
Wolfgang Betz 103:12684d94c3a6 340 volatile uint8_t tmpreg;
Wolfgang Betz 90:26c0c9807ab4 341
Wolfgang Betz 115:3b47df81a56b 342 unsigned char header_master[HEADER_SIZE] = {0x0a, 0x00, 0x00, 0x00, 0x00};
Wolfgang Betz 115:3b47df81a56b 343 unsigned char header_slave[HEADER_SIZE] = {0xaa, 0x00, 0x00, 0x00, 0x00};
Wolfgang Betz 115:3b47df81a56b 344
Wolfgang Betz 115:3b47df81a56b 345 //unsigned char read_char_buf[MAX_BUFFER_SIZE];
Wolfgang Betz 115:3b47df81a56b 346
Wolfgang Betz 115:3b47df81a56b 347 disable_irq();
Wolfgang Betz 115:3b47df81a56b 348
Wolfgang Betz 115:3b47df81a56b 349 /* CS reset */
Wolfgang Betz 115:3b47df81a56b 350 nCS_ = 0;
Wolfgang Betz 115:3b47df81a56b 351
Wolfgang Betz 115:3b47df81a56b 352 /* Exchange header */
Wolfgang Betz 115:3b47df81a56b 353 for (i = 0; i < 5; i++)
Wolfgang Betz 115:3b47df81a56b 354 {
Wolfgang Betz 103:12684d94c3a6 355 tmpreg = spi_.write(header_master[i]);
Wolfgang Betz 103:12684d94c3a6 356 header_slave[i] = tmpreg;
Wolfgang Betz 115:3b47df81a56b 357 }
Wolfgang Betz 115:3b47df81a56b 358
Wolfgang Betz 115:3b47df81a56b 359 if (header_slave[0] == 0x02) {
Wolfgang Betz 115:3b47df81a56b 360 /* SPI is ready */
Wolfgang Betz 115:3b47df81a56b 361 if (header_slave[1] >= (Nb_bytes1+Nb_bytes2)) {
Wolfgang Betz 115:3b47df81a56b 362
Wolfgang Betz 115:3b47df81a56b 363 /* Buffer is big enough */
Wolfgang Betz 103:12684d94c3a6 364 for (i = 0; i < Nb_bytes1; i++) {
Wolfgang Betz 115:3b47df81a56b 365 read_char = spi_.write(*(data1 + i));
Wolfgang Betz 115:3b47df81a56b 366 }
Wolfgang Betz 115:3b47df81a56b 367 for (i = 0; i < Nb_bytes2; i++) {
Wolfgang Betz 115:3b47df81a56b 368 read_char = spi_.write(*(data2 + i));
Wolfgang Betz 115:3b47df81a56b 369 }
Wolfgang Betz 90:26c0c9807ab4 370 } else {
Wolfgang Betz 115:3b47df81a56b 371 /* Buffer is too small */
Wolfgang Betz 115:3b47df81a56b 372 result = -2;
Wolfgang Betz 90:26c0c9807ab4 373 }
Wolfgang Betz 115:3b47df81a56b 374 } else {
Wolfgang Betz 115:3b47df81a56b 375 /* SPI is not ready */
Wolfgang Betz 115:3b47df81a56b 376 result = -1;
Wolfgang Betz 115:3b47df81a56b 377 }
Wolfgang Betz 90:26c0c9807ab4 378
Wolfgang Betz 115:3b47df81a56b 379 /* Release CS line */
Wolfgang Betz 115:3b47df81a56b 380 //HAL_GPIO_WritePin(BNRG_SPI_CS_PORT, BNRG_SPI_CS_PIN, GPIO_PIN_SET);
Wolfgang Betz 115:3b47df81a56b 381 nCS_ = 1;
Wolfgang Betz 115:3b47df81a56b 382
Wolfgang Betz 115:3b47df81a56b 383 enable_irq();
Wolfgang Betz 90:26c0c9807ab4 384
Wolfgang Betz 115:3b47df81a56b 385 return result;
Wolfgang Betz 90:26c0c9807ab4 386 }
Wolfgang Betz 115:3b47df81a56b 387
Wolfgang Betz 90:26c0c9807ab4 388 bool BlueNRGDevice::dataPresent()
Wolfgang Betz 90:26c0c9807ab4 389 {
Wolfgang Betz 90:26c0c9807ab4 390 return (irq_ == 1);
Wolfgang Betz 90:26c0c9807ab4 391 }
Wolfgang Betz 115:3b47df81a56b 392
Wolfgang Betz 90:26c0c9807ab4 393 void BlueNRGDevice::disable_irq()
Wolfgang Betz 90:26c0c9807ab4 394 {
Wolfgang Betz 90:26c0c9807ab4 395 irq_.disable_irq();
Wolfgang Betz 90:26c0c9807ab4 396 }
Wolfgang Betz 115:3b47df81a56b 397
Wolfgang Betz 90:26c0c9807ab4 398 void BlueNRGDevice::enable_irq()
Wolfgang Betz 90:26c0c9807ab4 399 {
Wolfgang Betz 90:26c0c9807ab4 400 irq_.enable_irq();
Wolfgang Betz 90:26c0c9807ab4 401 }