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@117:aff31e70cacc, 2015-09-03 (annotated)

Committer:
Wolfgang Betz
Date:
Thu Sep 03 11:54:31 2015 +0200
Revision:
117:aff31e70cacc
Parent:
116:1aa0d2da72e4
Child:
118:a172a5568535
Merge commit 'c278f52d085f9250eabcb95ae6ff2236fef4aec8' 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 116:1aa0d2da72e4 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 116:1aa0d2da72e4 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 116:1aa0d2da72e4 48
Wolfgang Betz 116:1aa0d2da72e4 49 #include "debug_hci.h"
Wolfgang Betz 115:3b47df81a56b 50 #include "stm32_bluenrg_ble.h"
Wolfgang Betz 116:1aa0d2da72e4 51
Wolfgang Betz 90:26c0c9807ab4 52 extern "C" {
Wolfgang Betz 117:aff31e70cacc 53 #include "hci.h"
Wolfgang Betz 90:26c0c9807ab4 54 }
Wolfgang Betz 116:1aa0d2da72e4 55
Wolfgang Betz 90:26c0c9807ab4 56 #define HEADER_SIZE 5
Wolfgang Betz 90:26c0c9807ab4 57 #define MAX_BUFFER_SIZE 255
Wolfgang Betz 116:1aa0d2da72e4 58
Wolfgang Betz 90:26c0c9807ab4 59 /**
Wolfgang Betz 116:1aa0d2da72e4 60 * The singleton which represents the BlueNRG transport for the BLEDevice.
Wolfgang Betz 116:1aa0d2da72e4 61 *
Wolfgang Betz 116:1aa0d2da72e4 62 * See file 'x_nucleo_idb0xa1_targets.h' for details regarding the peripheral pins used!
Wolfgang Betz 116:1aa0d2da72e4 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 117:aff31e70cacc 74 * BLE-API requires an implementation of the following function in order to
Wolfgang Betz 117:aff31e70cacc 75 * obtain its transport handle.
Wolfgang Betz 117:aff31e70cacc 76 */
Wolfgang Betz 90:26c0c9807ab4 77 BLEInstanceBase *
Wolfgang Betz 90:26c0c9807ab4 78 createBLEInstance(void)
Wolfgang Betz 90:26c0c9807ab4 79 {
Wolfgang Betz 117:aff31e70cacc 80 return (&bluenrgDeviceInstance);
Wolfgang Betz 90:26c0c9807ab4 81 }
Wolfgang Betz 116:1aa0d2da72e4 82
Wolfgang Betz 90:26c0c9807ab4 83 /**************************************************************************/
Wolfgang Betz 90:26c0c9807ab4 84 /**
Wolfgang Betz 117:aff31e70cacc 85 @brief Constructor
Wolfgang Betz 117:aff31e70cacc 86 * @param mosi mbed pin to use for MOSI line of SPI interface
Wolfgang Betz 117:aff31e70cacc 87 * @param miso mbed pin to use for MISO line of SPI interface
Wolfgang Betz 117:aff31e70cacc 88 * @param sck mbed pin to use for SCK line of SPI interface
Wolfgang Betz 117:aff31e70cacc 89 * @param cs mbed pin to use for not chip select line of SPI interface
Wolfgang Betz 117:aff31e70cacc 90 * @param rst mbed pin to use for BlueNRG reset
Wolfgang Betz 117:aff31e70cacc 91 * @param irq mbed pin for BlueNRG IRQ
Wolfgang Betz 117:aff31e70cacc 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 117:aff31e70cacc 101 isInitialized = false;
Wolfgang Betz 116:1aa0d2da72e4 102
Wolfgang Betz 117:aff31e70cacc 103 // Setup the spi for 8 bit data, low clock polarity,
Wolfgang Betz 117:aff31e70cacc 104 // 1-edge phase, with an 8MHz clock rate
Wolfgang Betz 117:aff31e70cacc 105 spi_.format(8, 0);
Wolfgang Betz 117:aff31e70cacc 106 spi_.frequency(8000000);
Wolfgang Betz 116:1aa0d2da72e4 107
Wolfgang Betz 117:aff31e70cacc 108 // Deselect the BlueNRG chip by keeping its nCS signal high
Wolfgang Betz 117:aff31e70cacc 109 nCS_ = 1;
Wolfgang Betz 116:1aa0d2da72e4 110
Wolfgang Betz 117:aff31e70cacc 111 wait_us(500);
Wolfgang Betz 90:26c0c9807ab4 112 }
Wolfgang Betz 116:1aa0d2da72e4 113
Wolfgang Betz 90:26c0c9807ab4 114 /**************************************************************************/
Wolfgang Betz 90:26c0c9807ab4 115 /**
Wolfgang Betz 117:aff31e70cacc 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 116:1aa0d2da72e4 122
Wolfgang Betz 116:1aa0d2da72e4 123
Wolfgang Betz 90:26c0c9807ab4 124 /**
Wolfgang Betz 117:aff31e70cacc 125 @brief Initialises anything required to start using BLE
Wolfgang Betz 117:aff31e70cacc 126 @param[in] void
Wolfgang Betz 117:aff31e70cacc 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 116:1aa0d2da72e4 131 // Set the interrupt handler for the device
Wolfgang Betz 116:1aa0d2da72e4 132 irq_.mode(PullNone); // betzw: set irq mode
Wolfgang Betz 116:1aa0d2da72e4 133 irq_.rise(&HCI_Isr);
Wolfgang Betz 116:1aa0d2da72e4 134
Wolfgang Betz 116:1aa0d2da72e4 135 /* ToDo: Clear memory contents, reset the SD, etc. */
Wolfgang Betz 116:1aa0d2da72e4 136 btle_init(BlueNRGGap::getInstance().getIsSetAddress());
Wolfgang Betz 116:1aa0d2da72e4 137
Wolfgang Betz 116:1aa0d2da72e4 138 isInitialized = true;
Wolfgang Betz 90:26c0c9807ab4 139
Wolfgang Betz 116:1aa0d2da72e4 140 return BLE_ERROR_NONE;
Wolfgang Betz 90:26c0c9807ab4 141 }
Wolfgang Betz 116:1aa0d2da72e4 142
Wolfgang Betz 116:1aa0d2da72e4 143
Wolfgang Betz 90:26c0c9807ab4 144 /**
Wolfgang Betz 117:aff31e70cacc 145 @brief Resets the BLE HW, removing any existing services and
Wolfgang Betz 117:aff31e70cacc 146 characteristics
Wolfgang Betz 117:aff31e70cacc 147 @param[in] void
Wolfgang Betz 117:aff31e70cacc 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 117:aff31e70cacc 152 wait_us(500);
Wolfgang Betz 116:1aa0d2da72e4 153
Wolfgang Betz 117:aff31e70cacc 154 /* Reset BlueNRG SPI interface */
Wolfgang Betz 117:aff31e70cacc 155 rst_ = 0;
Wolfgang Betz 116:1aa0d2da72e4 156 wait_us(5);
Wolfgang Betz 117:aff31e70cacc 157 rst_ = 1;
Wolfgang Betz 116:1aa0d2da72e4 158 wait_us(5);
Wolfgang Betz 116:1aa0d2da72e4 159
Wolfgang Betz 117:aff31e70cacc 160 /* Wait for the radio to come back up */
Wolfgang Betz 117:aff31e70cacc 161 wait_us(500);
Wolfgang Betz 90:26c0c9807ab4 162
Wolfgang Betz 117:aff31e70cacc 163 isInitialized = false;
Wolfgang Betz 116:1aa0d2da72e4 164
Wolfgang Betz 117:aff31e70cacc 165 return BLE_ERROR_NONE;
Wolfgang Betz 116:1aa0d2da72e4 166 }
Wolfgang Betz 116:1aa0d2da72e4 167
Wolfgang Betz 116:1aa0d2da72e4 168
Wolfgang Betz 116:1aa0d2da72e4 169 /*!
Wolfgang Betz 116:1aa0d2da72e4 170 @brief Wait for any BLE Event like BLE Connection, Read Request etc.
Wolfgang Betz 116:1aa0d2da72e4 171 @param[in] void
Wolfgang Betz 116:1aa0d2da72e4 172 @returns char *
Wolfgang Betz 116:1aa0d2da72e4 173 */
Wolfgang Betz 116:1aa0d2da72e4 174 void BlueNRGDevice::waitForEvent(void)
Wolfgang Betz 116:1aa0d2da72e4 175 {
Wolfgang Betz 116:1aa0d2da72e4 176 bool must_return = false;
Wolfgang Betz 116:1aa0d2da72e4 177
Wolfgang Betz 116:1aa0d2da72e4 178 do {
Wolfgang Betz 116:1aa0d2da72e4 179 HCI_Process();
Wolfgang Betz 116:1aa0d2da72e4 180
Wolfgang Betz 116:1aa0d2da72e4 181 if(must_return) return;
Wolfgang Betz 116:1aa0d2da72e4 182
Wolfgang Betz 116:1aa0d2da72e4 183 __WFE(); /* it is recommended that SEVONPEND in the
Wolfgang Betz 116:1aa0d2da72e4 184 System Control Register is NOT set */
Wolfgang Betz 116:1aa0d2da72e4 185 must_return = true; /* after returning from WFE we must guarantee
Wolfgang Betz 116:1aa0d2da72e4 186 that conrol is given back to main loop before next WFE */
Wolfgang Betz 116:1aa0d2da72e4 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 117:aff31e70cacc 192 @brief get GAP version
Wolfgang Betz 117:aff31e70cacc 193 @param[in] void
Wolfgang Betz 117:aff31e70cacc 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 117:aff31e70cacc 198 char *version = new char[6];
Wolfgang Betz 117:aff31e70cacc 199 memcpy((void *)version, "1.0.0", 5);
Wolfgang Betz 117:aff31e70cacc 200 return version;
Wolfgang Betz 90:26c0c9807ab4 201 }
Wolfgang Betz 116:1aa0d2da72e4 202
Wolfgang Betz 90:26c0c9807ab4 203 /**************************************************************************/
Wolfgang Betz 90:26c0c9807ab4 204 /*!
Wolfgang Betz 117:aff31e70cacc 205 @brief get init state
Wolfgang Betz 117:aff31e70cacc 206 @param[in] void
Wolfgang Betz 117:aff31e70cacc 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 117:aff31e70cacc 212 return isInitialized;
Wolfgang Betz 90:26c0c9807ab4 213 }
Wolfgang Betz 116:1aa0d2da72e4 214
Wolfgang Betz 90:26c0c9807ab4 215 /**************************************************************************/
Wolfgang Betz 90:26c0c9807ab4 216 /*!
Wolfgang Betz 117:aff31e70cacc 217 @brief get reference to GAP object
Wolfgang Betz 117:aff31e70cacc 218 @param[in] void
Wolfgang Betz 117:aff31e70cacc 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 117:aff31e70cacc 224 return BlueNRGGap::getInstance();
Wolfgang Betz 90:26c0c9807ab4 225 }
Wolfgang Betz 116:1aa0d2da72e4 226
Wolfgang Betz 90:26c0c9807ab4 227 const Gap &BlueNRGDevice::getGap() const
Wolfgang Betz 90:26c0c9807ab4 228 {
Wolfgang Betz 117:aff31e70cacc 229 return BlueNRGGap::getInstance();
Wolfgang Betz 90:26c0c9807ab4 230 }
Wolfgang Betz 116:1aa0d2da72e4 231
Wolfgang Betz 90:26c0c9807ab4 232 /**************************************************************************/
Wolfgang Betz 90:26c0c9807ab4 233 /*!
Wolfgang Betz 117:aff31e70cacc 234 @brief get reference to GATT server object
Wolfgang Betz 117:aff31e70cacc 235 @param[in] void
Wolfgang Betz 117:aff31e70cacc 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 117:aff31e70cacc 241 return BlueNRGGattServer::getInstance();
Wolfgang Betz 90:26c0c9807ab4 242 }
Wolfgang Betz 116:1aa0d2da72e4 243
Wolfgang Betz 90:26c0c9807ab4 244 const GattServer &BlueNRGDevice::getGattServer() const
Wolfgang Betz 90:26c0c9807ab4 245 {
Wolfgang Betz 117:aff31e70cacc 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 117:aff31e70cacc 251 @brief shut down the the BLE device
Wolfgang Betz 117:aff31e70cacc 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 117:aff31e70cacc 256 return reset();
Wolfgang Betz 90:26c0c9807ab4 257 }
Wolfgang Betz 116:1aa0d2da72e4 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 117:aff31e70cacc 267 uint16_t byte_count;
Wolfgang Betz 117:aff31e70cacc 268 uint8_t len = 0;
Wolfgang Betz 117:aff31e70cacc 269 uint8_t char_ff = 0xff;
Wolfgang Betz 117:aff31e70cacc 270 volatile uint8_t read_char;
Wolfgang Betz 116:1aa0d2da72e4 271
Wolfgang Betz 116:1aa0d2da72e4 272 uint8_t i = 0;
Wolfgang Betz 116:1aa0d2da72e4 273 volatile uint8_t tmpreg;
Wolfgang Betz 116:1aa0d2da72e4 274
Wolfgang Betz 117:aff31e70cacc 275 uint8_t header_master[HEADER_SIZE] = {0x0b, 0x00, 0x00, 0x00, 0x00};
Wolfgang Betz 117:aff31e70cacc 276 uint8_t header_slave[HEADER_SIZE];
Wolfgang Betz 116:1aa0d2da72e4 277
Wolfgang Betz 117:aff31e70cacc 278 /* Select the chip */
Wolfgang Betz 117:aff31e70cacc 279 nCS_ = 0;
Wolfgang Betz 116:1aa0d2da72e4 280
Wolfgang Betz 117:aff31e70cacc 281 /* Read the header */
Wolfgang Betz 117:aff31e70cacc 282 for (i = 0; i < 5; i++)
Wolfgang Betz 117:aff31e70cacc 283 {
Wolfgang Betz 117:aff31e70cacc 284 tmpreg = spi_.write(header_master[i]);
Wolfgang Betz 117:aff31e70cacc 285 header_slave[i] = (uint8_t)(tmpreg);
Wolfgang Betz 117:aff31e70cacc 286 }
Wolfgang Betz 116:1aa0d2da72e4 287
Wolfgang Betz 117:aff31e70cacc 288 if (header_slave[0] == 0x02) {
Wolfgang Betz 117:aff31e70cacc 289 /* device is ready */
Wolfgang Betz 117:aff31e70cacc 290 byte_count = (header_slave[4]<<8)|header_slave[3];
Wolfgang Betz 115:3b47df81a56b 291
Wolfgang Betz 117:aff31e70cacc 292 if (byte_count > 0) {
Wolfgang Betz 115:3b47df81a56b 293
Wolfgang Betz 117:aff31e70cacc 294 /* avoid to read more data that size of the buffer */
Wolfgang Betz 117:aff31e70cacc 295 if (byte_count > buff_size){
Wolfgang Betz 117:aff31e70cacc 296 byte_count = buff_size;
Wolfgang Betz 117:aff31e70cacc 297 }
Wolfgang Betz 115:3b47df81a56b 298
Wolfgang Betz 117:aff31e70cacc 299 for (len = 0; len < byte_count; len++){
Wolfgang Betz 117:aff31e70cacc 300 read_char = spi_.write(char_ff);
Wolfgang Betz 116:1aa0d2da72e4 301 buffer[len] = read_char;
Wolfgang Betz 117:aff31e70cacc 302 }
Wolfgang Betz 117:aff31e70cacc 303 }
Wolfgang Betz 117:aff31e70cacc 304 }
Wolfgang Betz 117:aff31e70cacc 305 /* Release CS line to deselect the chip */
Wolfgang Betz 117:aff31e70cacc 306 nCS_ = 1;
Wolfgang Betz 116:1aa0d2da72e4 307
Wolfgang Betz 117:aff31e70cacc 308 // Add a small delay to give time to the BlueNRG to set the IRQ pin low
Wolfgang Betz 117:aff31e70cacc 309 // to avoid a useless SPI read at the end of the transaction
Wolfgang Betz 117:aff31e70cacc 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 117:aff31e70cacc 313 if (len > 0) {
Wolfgang Betz 117:aff31e70cacc 314 print_csv_time();
Wolfgang Betz 117:aff31e70cacc 315 for (int i=0; i<len; i++) {
Wolfgang Betz 117:aff31e70cacc 316 PRINT_CSV(" %02x", buffer[i]);
Wolfgang Betz 117:aff31e70cacc 317 }
Wolfgang Betz 117:aff31e70cacc 318 PRINT_CSV("\n");
Wolfgang Betz 117:aff31e70cacc 319 }
Wolfgang Betz 90:26c0c9807ab4 320 #endif
Wolfgang Betz 115:3b47df81a56b 321
Wolfgang Betz 117:aff31e70cacc 322 return len;
Wolfgang Betz 90:26c0c9807ab4 323 }
Wolfgang Betz 116:1aa0d2da72e4 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 116:1aa0d2da72e4 334 uint8_t* data2, uint8_t Nb_bytes1, uint8_t Nb_bytes2)
Wolfgang Betz 90:26c0c9807ab4 335 {
Wolfgang Betz 116:1aa0d2da72e4 336 int32_t result = 0;
Wolfgang Betz 116:1aa0d2da72e4 337
Wolfgang Betz 116:1aa0d2da72e4 338 uint32_t i;
Wolfgang Betz 116:1aa0d2da72e4 339 volatile uint8_t tmpreg;
Wolfgang Betz 115:3b47df81a56b 340
Wolfgang Betz 116:1aa0d2da72e4 341 unsigned char header_master[HEADER_SIZE] = {0x0a, 0x00, 0x00, 0x00, 0x00};
Wolfgang Betz 116:1aa0d2da72e4 342 unsigned char header_slave[HEADER_SIZE] = {0xaa, 0x00, 0x00, 0x00, 0x00};
Wolfgang Betz 116:1aa0d2da72e4 343
Wolfgang Betz 116:1aa0d2da72e4 344 disable_irq();
Wolfgang Betz 116:1aa0d2da72e4 345
Wolfgang Betz 116:1aa0d2da72e4 346 /* CS reset */
Wolfgang Betz 116:1aa0d2da72e4 347 nCS_ = 0;
Wolfgang Betz 116:1aa0d2da72e4 348
Wolfgang Betz 116:1aa0d2da72e4 349 /* Exchange header */
Wolfgang Betz 116:1aa0d2da72e4 350 for (i = 0; i < 5; i++)
Wolfgang Betz 116:1aa0d2da72e4 351 {
Wolfgang Betz 116:1aa0d2da72e4 352 tmpreg = spi_.write(header_master[i]);
Wolfgang Betz 116:1aa0d2da72e4 353 header_slave[i] = tmpreg;
Wolfgang Betz 116:1aa0d2da72e4 354 }
Wolfgang Betz 116:1aa0d2da72e4 355
Wolfgang Betz 116:1aa0d2da72e4 356 if (header_slave[0] == 0x02) {
Wolfgang Betz 116:1aa0d2da72e4 357 /* SPI is ready */
Wolfgang Betz 116:1aa0d2da72e4 358 if (header_slave[1] >= (Nb_bytes1+Nb_bytes2)) {
Wolfgang Betz 115:3b47df81a56b 359
Wolfgang Betz 116:1aa0d2da72e4 360 /* Buffer is big enough */
Wolfgang Betz 116:1aa0d2da72e4 361 for (i = 0; i < Nb_bytes1; i++) {
Wolfgang Betz 116:1aa0d2da72e4 362 spi_.write(*(data1 + i));
Wolfgang Betz 116:1aa0d2da72e4 363 }
Wolfgang Betz 116:1aa0d2da72e4 364 for (i = 0; i < Nb_bytes2; i++) {
Wolfgang Betz 116:1aa0d2da72e4 365 spi_.write(*(data2 + i));
Wolfgang Betz 116:1aa0d2da72e4 366 }
Wolfgang Betz 116:1aa0d2da72e4 367 } else {
Wolfgang Betz 116:1aa0d2da72e4 368 /* Buffer is too small */
Wolfgang Betz 116:1aa0d2da72e4 369 result = -2;
Wolfgang Betz 116:1aa0d2da72e4 370 }
Wolfgang Betz 116:1aa0d2da72e4 371 } else {
Wolfgang Betz 116:1aa0d2da72e4 372 /* SPI is not ready */
Wolfgang Betz 116:1aa0d2da72e4 373 result = -1;
Wolfgang Betz 116:1aa0d2da72e4 374 }
Wolfgang Betz 90:26c0c9807ab4 375
Wolfgang Betz 116:1aa0d2da72e4 376 /* Release CS line */
Wolfgang Betz 116:1aa0d2da72e4 377 //HAL_GPIO_WritePin(BNRG_SPI_CS_PORT, BNRG_SPI_CS_PIN, GPIO_PIN_SET);
Wolfgang Betz 116:1aa0d2da72e4 378 nCS_ = 1;
Wolfgang Betz 116:1aa0d2da72e4 379
Wolfgang Betz 116:1aa0d2da72e4 380 enable_irq();
Wolfgang Betz 90:26c0c9807ab4 381
Wolfgang Betz 116:1aa0d2da72e4 382 return result;
Wolfgang Betz 90:26c0c9807ab4 383 }
Wolfgang Betz 116:1aa0d2da72e4 384
Wolfgang Betz 90:26c0c9807ab4 385 bool BlueNRGDevice::dataPresent()
Wolfgang Betz 90:26c0c9807ab4 386 {
Wolfgang Betz 117:aff31e70cacc 387 return (irq_ == 1);
Wolfgang Betz 90:26c0c9807ab4 388 }
Wolfgang Betz 116:1aa0d2da72e4 389
Wolfgang Betz 90:26c0c9807ab4 390 void BlueNRGDevice::disable_irq()
Wolfgang Betz 90:26c0c9807ab4 391 {
Wolfgang Betz 117:aff31e70cacc 392 irq_.disable_irq();
Wolfgang Betz 90:26c0c9807ab4 393 }
Wolfgang Betz 116:1aa0d2da72e4 394
Wolfgang Betz 90:26c0c9807ab4 395 void BlueNRGDevice::enable_irq()
Wolfgang Betz 90:26c0c9807ab4 396 {
Wolfgang Betz 117:aff31e70cacc 397 irq_.enable_irq();
Wolfgang Betz 90:26c0c9807ab4 398 }