Roman Ciesarík / bluenrg_interface

bluenrg_interface

main.c@0:fb1547f2354e, 2018-11-12 (annotated)

Committer:
Ciesarik3
Date:
Mon Nov 12 18:36:18 2018 +0000
Revision:
0:fb1547f2354e
crc;

Who changed what in which revision?

UserRevisionLine numberNew contents of line
Ciesarik3 0:fb1547f2354e 1 /**
Ciesarik3 0:fb1547f2354e 2 ******************************************************************************
Ciesarik3 0:fb1547f2354e 3 * @file main.c
Ciesarik3 0:fb1547f2354e 4 * @author CL
Ciesarik3 0:fb1547f2354e 5 * @version V1.0.0
Ciesarik3 0:fb1547f2354e 6 * @date 04-July-2014
Ciesarik3 0:fb1547f2354e 7 * @brief This application contains an example which shows how implementing
Ciesarik3 0:fb1547f2354e 8 * a proprietary Bluetooth Low Energy profile: the sensor profile.
Ciesarik3 0:fb1547f2354e 9 * The communication is done using a Nucleo board and a Smartphone
Ciesarik3 0:fb1547f2354e 10 * with BTLE.
Ciesarik3 0:fb1547f2354e 11 ******************************************************************************
Ciesarik3 0:fb1547f2354e 12 * @attention
Ciesarik3 0:fb1547f2354e 13 *
Ciesarik3 0:fb1547f2354e 14 * <h2><center>&copy; COPYRIGHT(c) 2014 STMicroelectronics</center></h2>
Ciesarik3 0:fb1547f2354e 15 *
Ciesarik3 0:fb1547f2354e 16 * Redistribution and use in source and binary forms, with or without modification,
Ciesarik3 0:fb1547f2354e 17 * are permitted provided that the following conditions are met:
Ciesarik3 0:fb1547f2354e 18 * 1. Redistributions of source code must retain the above copyright notice,
Ciesarik3 0:fb1547f2354e 19 * this list of conditions and the following disclaimer.
Ciesarik3 0:fb1547f2354e 20 * 2. Redistributions in binary form must reproduce the above copyright notice,
Ciesarik3 0:fb1547f2354e 21 * this list of conditions and the following disclaimer in the documentation
Ciesarik3 0:fb1547f2354e 22 * and/or other materials provided with the distribution.
Ciesarik3 0:fb1547f2354e 23 * 3. Neither the name of STMicroelectronics nor the names of its contributors
Ciesarik3 0:fb1547f2354e 24 * may be used to endorse or promote products derived from this software
Ciesarik3 0:fb1547f2354e 25 * without specific prior written permission.
Ciesarik3 0:fb1547f2354e 26 *
Ciesarik3 0:fb1547f2354e 27 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
Ciesarik3 0:fb1547f2354e 28 * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
Ciesarik3 0:fb1547f2354e 29 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
Ciesarik3 0:fb1547f2354e 30 * DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE
Ciesarik3 0:fb1547f2354e 31 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
Ciesarik3 0:fb1547f2354e 32 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
Ciesarik3 0:fb1547f2354e 33 * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
Ciesarik3 0:fb1547f2354e 34 * CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
Ciesarik3 0:fb1547f2354e 35 * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
Ciesarik3 0:fb1547f2354e 36 * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
Ciesarik3 0:fb1547f2354e 37 *
Ciesarik3 0:fb1547f2354e 38 ******************************************************************************
Ciesarik3 0:fb1547f2354e 39 */
Ciesarik3 0:fb1547f2354e 40
Ciesarik3 0:fb1547f2354e 41 /* Includes ------------------------------------------------------------------*/
Ciesarik3 0:fb1547f2354e 42 #include "cube_hal.h"
Ciesarik3 0:fb1547f2354e 43
Ciesarik3 0:fb1547f2354e 44 /* USER CODE BEGIN Includes */
Ciesarik3 0:fb1547f2354e 45 #include "osal.h"
Ciesarik3 0:fb1547f2354e 46 #include "sensor_service.h"
Ciesarik3 0:fb1547f2354e 47 #include "debug.h"
Ciesarik3 0:fb1547f2354e 48 #include "stm32_bluenrg_ble.h"
Ciesarik3 0:fb1547f2354e 49 #include "bluenrg_utils.h"
Ciesarik3 0:fb1547f2354e 50 /* USER CODE END Includes */
Ciesarik3 0:fb1547f2354e 51
Ciesarik3 0:fb1547f2354e 52 /** @addtogroup X-CUBE-BLE1_Applications
Ciesarik3 0:fb1547f2354e 53 * @{
Ciesarik3 0:fb1547f2354e 54 */
Ciesarik3 0:fb1547f2354e 55
Ciesarik3 0:fb1547f2354e 56 /** @defgroup SensorDemo
Ciesarik3 0:fb1547f2354e 57 * @{
Ciesarik3 0:fb1547f2354e 58 */
Ciesarik3 0:fb1547f2354e 59
Ciesarik3 0:fb1547f2354e 60 /** @defgroup MAIN
Ciesarik3 0:fb1547f2354e 61 * @{
Ciesarik3 0:fb1547f2354e 62 */
Ciesarik3 0:fb1547f2354e 63
Ciesarik3 0:fb1547f2354e 64 /* USER CODE BEGIN PV */
Ciesarik3 0:fb1547f2354e 65 /** @defgroup MAIN_Private_Defines
Ciesarik3 0:fb1547f2354e 66 * @{
Ciesarik3 0:fb1547f2354e 67 */
Ciesarik3 0:fb1547f2354e 68 /* Private defines -----------------------------------------------------------*/
Ciesarik3 0:fb1547f2354e 69 #define BDADDR_SIZE 6
Ciesarik3 0:fb1547f2354e 70 /**
Ciesarik3 0:fb1547f2354e 71 * @}
Ciesarik3 0:fb1547f2354e 72 */
Ciesarik3 0:fb1547f2354e 73
Ciesarik3 0:fb1547f2354e 74 /* Private macros ------------------------------------------------------------*/
Ciesarik3 0:fb1547f2354e 75
Ciesarik3 0:fb1547f2354e 76 /** @defgroup MAIN_Private_Variables
Ciesarik3 0:fb1547f2354e 77 * @{
Ciesarik3 0:fb1547f2354e 78 */
Ciesarik3 0:fb1547f2354e 79 /* Private variables ---------------------------------------------------------*/
Ciesarik3 0:fb1547f2354e 80 extern volatile uint8_t set_connectable;
Ciesarik3 0:fb1547f2354e 81 extern volatile int connected;
Ciesarik3 0:fb1547f2354e 82 extern AxesRaw_t axes_data;
Ciesarik3 0:fb1547f2354e 83 uint8_t bnrg_expansion_board = IDB04A1; /* at startup, suppose the X-NUCLEO-IDB04A1 is used */
Ciesarik3 0:fb1547f2354e 84 /**
Ciesarik3 0:fb1547f2354e 85 * @}
Ciesarik3 0:fb1547f2354e 86 */
Ciesarik3 0:fb1547f2354e 87 /* USER CODE END PV */
Ciesarik3 0:fb1547f2354e 88
Ciesarik3 0:fb1547f2354e 89 /** @defgroup MAIN_Private_Function_Prototypes
Ciesarik3 0:fb1547f2354e 90 * @{
Ciesarik3 0:fb1547f2354e 91 */
Ciesarik3 0:fb1547f2354e 92 /* USER CODE BEGIN PFP */
Ciesarik3 0:fb1547f2354e 93 /* Private function prototypes -----------------------------------------------*/
Ciesarik3 0:fb1547f2354e 94 void User_Process(AxesRaw_t* p_axes);
Ciesarik3 0:fb1547f2354e 95 /* USER CODE END PFP */
Ciesarik3 0:fb1547f2354e 96 /**
Ciesarik3 0:fb1547f2354e 97 * @}
Ciesarik3 0:fb1547f2354e 98 */
Ciesarik3 0:fb1547f2354e 99
Ciesarik3 0:fb1547f2354e 100 /* USER CODE BEGIN 0 */
Ciesarik3 0:fb1547f2354e 101
Ciesarik3 0:fb1547f2354e 102 /* USER CODE END 0 */
Ciesarik3 0:fb1547f2354e 103
Ciesarik3 0:fb1547f2354e 104 /**
Ciesarik3 0:fb1547f2354e 105 * @brief Main function to show how to use the BlueNRG Bluetooth Low Energy
Ciesarik3 0:fb1547f2354e 106 * expansion board to send data from a Nucleo board to a smartphone
Ciesarik3 0:fb1547f2354e 107 * with the support BLE and the "BlueNRG" app freely available on both
Ciesarik3 0:fb1547f2354e 108 * GooglePlay and iTunes.
Ciesarik3 0:fb1547f2354e 109 * The URL to the iTunes for the "BlueNRG" app is
Ciesarik3 0:fb1547f2354e 110 * http://itunes.apple.com/app/bluenrg/id705873549?uo=5
Ciesarik3 0:fb1547f2354e 111 * The URL to the GooglePlay is
Ciesarik3 0:fb1547f2354e 112 * https://play.google.com/store/apps/details?id=com.st.bluenrg
Ciesarik3 0:fb1547f2354e 113 * The source code of the "BlueNRG" app, both for iOS and Android, is
Ciesarik3 0:fb1547f2354e 114 * freely downloadable from the developer website at
Ciesarik3 0:fb1547f2354e 115 * http://software.g-maps.it/
Ciesarik3 0:fb1547f2354e 116 * The board will act as Server-Peripheral.
Ciesarik3 0:fb1547f2354e 117 *
Ciesarik3 0:fb1547f2354e 118 * After connection has been established:
Ciesarik3 0:fb1547f2354e 119 * - by pressing the USER button on the board, the cube showed by
Ciesarik3 0:fb1547f2354e 120 * the app on the smartphone will rotate.
Ciesarik3 0:fb1547f2354e 121 *
Ciesarik3 0:fb1547f2354e 122 * The communication is done using a vendor specific profile.
Ciesarik3 0:fb1547f2354e 123 *
Ciesarik3 0:fb1547f2354e 124 * @param None
Ciesarik3 0:fb1547f2354e 125 * @retval None
Ciesarik3 0:fb1547f2354e 126 */
Ciesarik3 0:fb1547f2354e 127 int main(void)
Ciesarik3 0:fb1547f2354e 128 {
Ciesarik3 0:fb1547f2354e 129 /* USER CODE BEGIN 1 */
Ciesarik3 0:fb1547f2354e 130 const char *name = "BlueNRG";
Ciesarik3 0:fb1547f2354e 131 uint8_t SERVER_BDADDR[] = {0x12, 0x34, 0x00, 0xE1, 0x80, 0x03};
Ciesarik3 0:fb1547f2354e 132 uint8_t bdaddr[BDADDR_SIZE];
Ciesarik3 0:fb1547f2354e 133 uint16_t service_handle, dev_name_char_handle, appearance_char_handle;
Ciesarik3 0:fb1547f2354e 134
Ciesarik3 0:fb1547f2354e 135 uint8_t hwVersion;
Ciesarik3 0:fb1547f2354e 136 uint16_t fwVersion;
Ciesarik3 0:fb1547f2354e 137
Ciesarik3 0:fb1547f2354e 138 int ret;
Ciesarik3 0:fb1547f2354e 139 /* USER CODE END 1 */
Ciesarik3 0:fb1547f2354e 140
Ciesarik3 0:fb1547f2354e 141 /* STM32Cube HAL library initialization:
Ciesarik3 0:fb1547f2354e 142 * - Configure the Flash prefetch, Flash preread and Buffer caches
Ciesarik3 0:fb1547f2354e 143 * - Systick timer is configured by default as source of time base, but user
Ciesarik3 0:fb1547f2354e 144 * can eventually implement his proper time base source (a general purpose
Ciesarik3 0:fb1547f2354e 145 * timer for example or other time source), keeping in mind that Time base
Ciesarik3 0:fb1547f2354e 146 * duration should be kept 1ms since PPP_TIMEOUT_VALUEs are defined and
Ciesarik3 0:fb1547f2354e 147 * handled in milliseconds basis.
Ciesarik3 0:fb1547f2354e 148 * - Low Level Initialization
Ciesarik3 0:fb1547f2354e 149 */
Ciesarik3 0:fb1547f2354e 150 HAL_Init();
Ciesarik3 0:fb1547f2354e 151
Ciesarik3 0:fb1547f2354e 152 /* USER CODE BEGIN Init */
Ciesarik3 0:fb1547f2354e 153 #if NEW_SERVICES
Ciesarik3 0:fb1547f2354e 154 /* Configure LED2 */
Ciesarik3 0:fb1547f2354e 155 BSP_LED_Init(LED2);
Ciesarik3 0:fb1547f2354e 156 #endif
Ciesarik3 0:fb1547f2354e 157
Ciesarik3 0:fb1547f2354e 158 /* Configure the User Button in GPIO Mode */
Ciesarik3 0:fb1547f2354e 159 BSP_PB_Init(BUTTON_KEY, BUTTON_MODE_GPIO);
Ciesarik3 0:fb1547f2354e 160 /* USER CODE END Init */
Ciesarik3 0:fb1547f2354e 161
Ciesarik3 0:fb1547f2354e 162 /* Configure the system clock */
Ciesarik3 0:fb1547f2354e 163 SystemClock_Config();
Ciesarik3 0:fb1547f2354e 164
Ciesarik3 0:fb1547f2354e 165 /* USER CODE BEGIN SysInit */
Ciesarik3 0:fb1547f2354e 166
Ciesarik3 0:fb1547f2354e 167 /* USER CODE END SysInit */
Ciesarik3 0:fb1547f2354e 168
Ciesarik3 0:fb1547f2354e 169 /* Initialize the BlueNRG SPI driver */
Ciesarik3 0:fb1547f2354e 170 BNRG_SPI_Init();
Ciesarik3 0:fb1547f2354e 171
Ciesarik3 0:fb1547f2354e 172 /* Initialize the BlueNRG HCI */
Ciesarik3 0:fb1547f2354e 173 HCI_Init();
Ciesarik3 0:fb1547f2354e 174
Ciesarik3 0:fb1547f2354e 175 /* Reset BlueNRG hardware */
Ciesarik3 0:fb1547f2354e 176 BlueNRG_RST();
Ciesarik3 0:fb1547f2354e 177
Ciesarik3 0:fb1547f2354e 178 /* USER CODE BEGIN 2 */
Ciesarik3 0:fb1547f2354e 179 /* get the BlueNRG HW and FW versions */
Ciesarik3 0:fb1547f2354e 180 getBlueNRGVersion(&hwVersion, &fwVersion);
Ciesarik3 0:fb1547f2354e 181
Ciesarik3 0:fb1547f2354e 182 /*
Ciesarik3 0:fb1547f2354e 183 * Reset BlueNRG again otherwise we won't
Ciesarik3 0:fb1547f2354e 184 * be able to change its MAC address.
Ciesarik3 0:fb1547f2354e 185 * aci_hal_write_config_data() must be the first
Ciesarik3 0:fb1547f2354e 186 * command after reset otherwise it will fail.
Ciesarik3 0:fb1547f2354e 187 */
Ciesarik3 0:fb1547f2354e 188 BlueNRG_RST();
Ciesarik3 0:fb1547f2354e 189
Ciesarik3 0:fb1547f2354e 190 PRINTF("HWver %d, FWver %d", hwVersion, fwVersion);
Ciesarik3 0:fb1547f2354e 191
Ciesarik3 0:fb1547f2354e 192 if (hwVersion > 0x30) { /* X-NUCLEO-IDB05A1 expansion board is used */
Ciesarik3 0:fb1547f2354e 193 bnrg_expansion_board = IDB05A1;
Ciesarik3 0:fb1547f2354e 194 /*
Ciesarik3 0:fb1547f2354e 195 * Change the MAC address to avoid issues with Android cache:
Ciesarik3 0:fb1547f2354e 196 * if different boards have the same MAC address, Android
Ciesarik3 0:fb1547f2354e 197 * applications unless you restart Bluetooth on tablet/phone
Ciesarik3 0:fb1547f2354e 198 */
Ciesarik3 0:fb1547f2354e 199 SERVER_BDADDR[5] = 0x02;
Ciesarik3 0:fb1547f2354e 200 }
Ciesarik3 0:fb1547f2354e 201
Ciesarik3 0:fb1547f2354e 202 /* The Nucleo board must be configured as SERVER */
Ciesarik3 0:fb1547f2354e 203 Osal_MemCpy(bdaddr, SERVER_BDADDR, sizeof(SERVER_BDADDR));
Ciesarik3 0:fb1547f2354e 204
Ciesarik3 0:fb1547f2354e 205 ret = aci_hal_write_config_data(CONFIG_DATA_PUBADDR_OFFSET,
Ciesarik3 0:fb1547f2354e 206 CONFIG_DATA_PUBADDR_LEN,
Ciesarik3 0:fb1547f2354e 207 bdaddr);
Ciesarik3 0:fb1547f2354e 208 if(ret){
Ciesarik3 0:fb1547f2354e 209 PRINTF("Setting BD_ADDR failed.\n");
Ciesarik3 0:fb1547f2354e 210 }
Ciesarik3 0:fb1547f2354e 211
Ciesarik3 0:fb1547f2354e 212 ret = aci_gatt_init();
Ciesarik3 0:fb1547f2354e 213 if(ret){
Ciesarik3 0:fb1547f2354e 214 PRINTF("GATT_Init failed.\n");
Ciesarik3 0:fb1547f2354e 215 }
Ciesarik3 0:fb1547f2354e 216
Ciesarik3 0:fb1547f2354e 217 if (bnrg_expansion_board == IDB05A1) {
Ciesarik3 0:fb1547f2354e 218 ret = aci_gap_init_IDB05A1(GAP_PERIPHERAL_ROLE_IDB05A1, 0, 0x07, &service_handle, &dev_name_char_handle, &appearance_char_handle);
Ciesarik3 0:fb1547f2354e 219 }
Ciesarik3 0:fb1547f2354e 220 else {
Ciesarik3 0:fb1547f2354e 221 ret = aci_gap_init_IDB04A1(GAP_PERIPHERAL_ROLE_IDB04A1, &service_handle, &dev_name_char_handle, &appearance_char_handle);
Ciesarik3 0:fb1547f2354e 222 }
Ciesarik3 0:fb1547f2354e 223
Ciesarik3 0:fb1547f2354e 224 if(ret != BLE_STATUS_SUCCESS){
Ciesarik3 0:fb1547f2354e 225 PRINTF("GAP_Init failed.\n");
Ciesarik3 0:fb1547f2354e 226 }
Ciesarik3 0:fb1547f2354e 227
Ciesarik3 0:fb1547f2354e 228 ret = aci_gatt_update_char_value(service_handle, dev_name_char_handle, 0,
Ciesarik3 0:fb1547f2354e 229 strlen(name), (uint8_t *)name);
Ciesarik3 0:fb1547f2354e 230
Ciesarik3 0:fb1547f2354e 231 if(ret){
Ciesarik3 0:fb1547f2354e 232 PRINTF("aci_gatt_update_char_value failed.\n");
Ciesarik3 0:fb1547f2354e 233 while(1);
Ciesarik3 0:fb1547f2354e 234 }
Ciesarik3 0:fb1547f2354e 235
Ciesarik3 0:fb1547f2354e 236 ret = aci_gap_set_auth_requirement(MITM_PROTECTION_REQUIRED,
Ciesarik3 0:fb1547f2354e 237 OOB_AUTH_DATA_ABSENT,
Ciesarik3 0:fb1547f2354e 238 NULL,
Ciesarik3 0:fb1547f2354e 239 7,
Ciesarik3 0:fb1547f2354e 240 16,
Ciesarik3 0:fb1547f2354e 241 USE_FIXED_PIN_FOR_PAIRING,
Ciesarik3 0:fb1547f2354e 242 123456,
Ciesarik3 0:fb1547f2354e 243 BONDING);
Ciesarik3 0:fb1547f2354e 244 if (ret == BLE_STATUS_SUCCESS) {
Ciesarik3 0:fb1547f2354e 245 PRINTF("BLE Stack Initialized.\n");
Ciesarik3 0:fb1547f2354e 246 }
Ciesarik3 0:fb1547f2354e 247
Ciesarik3 0:fb1547f2354e 248 PRINTF("SERVER: BLE Stack Initialized\n");
Ciesarik3 0:fb1547f2354e 249
Ciesarik3 0:fb1547f2354e 250 ret = Add_Acc_Service();
Ciesarik3 0:fb1547f2354e 251
Ciesarik3 0:fb1547f2354e 252 if(ret == BLE_STATUS_SUCCESS)
Ciesarik3 0:fb1547f2354e 253 PRINTF("Acc service added successfully.\n");
Ciesarik3 0:fb1547f2354e 254 else
Ciesarik3 0:fb1547f2354e 255 PRINTF("Error while adding Acc service.\n");
Ciesarik3 0:fb1547f2354e 256
Ciesarik3 0:fb1547f2354e 257 ret = Add_Environmental_Sensor_Service();
Ciesarik3 0:fb1547f2354e 258
Ciesarik3 0:fb1547f2354e 259 if(ret == BLE_STATUS_SUCCESS)
Ciesarik3 0:fb1547f2354e 260 PRINTF("Environmental Sensor service added successfully.\n");
Ciesarik3 0:fb1547f2354e 261 else
Ciesarik3 0:fb1547f2354e 262 PRINTF("Error while adding Environmental Sensor service.\n");
Ciesarik3 0:fb1547f2354e 263
Ciesarik3 0:fb1547f2354e 264 #if NEW_SERVICES
Ciesarik3 0:fb1547f2354e 265 /* Instantiate Timer Service with two characteristics:
Ciesarik3 0:fb1547f2354e 266 * - seconds characteristic (Readable only)
Ciesarik3 0:fb1547f2354e 267 * - minutes characteristics (Readable and Notifiable )
Ciesarik3 0:fb1547f2354e 268 */
Ciesarik3 0:fb1547f2354e 269 ret = Add_Time_Service();
Ciesarik3 0:fb1547f2354e 270
Ciesarik3 0:fb1547f2354e 271 if(ret == BLE_STATUS_SUCCESS)
Ciesarik3 0:fb1547f2354e 272 PRINTF("Time service added successfully.\n");
Ciesarik3 0:fb1547f2354e 273 else
Ciesarik3 0:fb1547f2354e 274 PRINTF("Error while adding Time service.\n");
Ciesarik3 0:fb1547f2354e 275
Ciesarik3 0:fb1547f2354e 276 /* Instantiate LED Button Service with one characteristic:
Ciesarik3 0:fb1547f2354e 277 * - LED characteristic (Readable and Writable)
Ciesarik3 0:fb1547f2354e 278 */
Ciesarik3 0:fb1547f2354e 279 ret = Add_LED_Service();
Ciesarik3 0:fb1547f2354e 280
Ciesarik3 0:fb1547f2354e 281 if(ret == BLE_STATUS_SUCCESS)
Ciesarik3 0:fb1547f2354e 282 PRINTF("LED service added successfully.\n");
Ciesarik3 0:fb1547f2354e 283 else
Ciesarik3 0:fb1547f2354e 284 PRINTF("Error while adding LED service.\n");
Ciesarik3 0:fb1547f2354e 285 #endif
Ciesarik3 0:fb1547f2354e 286
Ciesarik3 0:fb1547f2354e 287 /* Set output power level */
Ciesarik3 0:fb1547f2354e 288 ret = aci_hal_set_tx_power_level(1,4);
Ciesarik3 0:fb1547f2354e 289 /* USER CODE END 2 */
Ciesarik3 0:fb1547f2354e 290
Ciesarik3 0:fb1547f2354e 291 /* Infinite loop */
Ciesarik3 0:fb1547f2354e 292 /* USER CODE BEGIN WHILE */
Ciesarik3 0:fb1547f2354e 293 while(1)
Ciesarik3 0:fb1547f2354e 294 {
Ciesarik3 0:fb1547f2354e 295 /* USER CODE END WHILE */
Ciesarik3 0:fb1547f2354e 296 /* USER CODE BEGIN 3 */
Ciesarik3 0:fb1547f2354e 297 HCI_Process();
Ciesarik3 0:fb1547f2354e 298 User_Process(&axes_data);
Ciesarik3 0:fb1547f2354e 299 #if NEW_SERVICES
Ciesarik3 0:fb1547f2354e 300 Update_Time_Characteristics();
Ciesarik3 0:fb1547f2354e 301 #endif
Ciesarik3 0:fb1547f2354e 302 }
Ciesarik3 0:fb1547f2354e 303 /* USER CODE END 3 */
Ciesarik3 0:fb1547f2354e 304
Ciesarik3 0:fb1547f2354e 305 }
Ciesarik3 0:fb1547f2354e 306
Ciesarik3 0:fb1547f2354e 307 /* USER CODE BEGIN 4 */
Ciesarik3 0:fb1547f2354e 308 /**
Ciesarik3 0:fb1547f2354e 309 * @brief Process user input (i.e. pressing the USER button on Nucleo board)
Ciesarik3 0:fb1547f2354e 310 * and send the updated acceleration data to the remote client.
Ciesarik3 0:fb1547f2354e 311 *
Ciesarik3 0:fb1547f2354e 312 * @param AxesRaw_t* p_axes
Ciesarik3 0:fb1547f2354e 313 * @retval None
Ciesarik3 0:fb1547f2354e 314 */
Ciesarik3 0:fb1547f2354e 315 void User_Process(AxesRaw_t* p_axes)
Ciesarik3 0:fb1547f2354e 316 {
Ciesarik3 0:fb1547f2354e 317 if(set_connectable){
Ciesarik3 0:fb1547f2354e 318 setConnectable();
Ciesarik3 0:fb1547f2354e 319 set_connectable = FALSE;
Ciesarik3 0:fb1547f2354e 320 }
Ciesarik3 0:fb1547f2354e 321
Ciesarik3 0:fb1547f2354e 322 /* Check if the user has pushed the button */
Ciesarik3 0:fb1547f2354e 323 if(BSP_PB_GetState(BUTTON_KEY) == RESET)
Ciesarik3 0:fb1547f2354e 324 {
Ciesarik3 0:fb1547f2354e 325 while (BSP_PB_GetState(BUTTON_KEY) == RESET);
Ciesarik3 0:fb1547f2354e 326
Ciesarik3 0:fb1547f2354e 327 //BSP_LED_Toggle(LED2); //used for debugging (BSP_LED_Init() above must be also enabled)
Ciesarik3 0:fb1547f2354e 328
Ciesarik3 0:fb1547f2354e 329 if(connected)
Ciesarik3 0:fb1547f2354e 330 {
Ciesarik3 0:fb1547f2354e 331 /* Update acceleration data */
Ciesarik3 0:fb1547f2354e 332 p_axes->AXIS_X += 100;
Ciesarik3 0:fb1547f2354e 333 p_axes->AXIS_Y += 100;
Ciesarik3 0:fb1547f2354e 334 p_axes->AXIS_Z += 100;
Ciesarik3 0:fb1547f2354e 335 //PRINTF("ACC: X=%6d Y=%6d Z=%6d\r\n", p_axes->AXIS_X, p_axes->AXIS_Y, p_axes->AXIS_Z);
Ciesarik3 0:fb1547f2354e 336 Acc_Update(p_axes);
Ciesarik3 0:fb1547f2354e 337 }
Ciesarik3 0:fb1547f2354e 338 }
Ciesarik3 0:fb1547f2354e 339 }
Ciesarik3 0:fb1547f2354e 340 /* USER CODE END 4 */
Ciesarik3 0:fb1547f2354e 341
Ciesarik3 0:fb1547f2354e 342 /**
Ciesarik3 0:fb1547f2354e 343 * @}
Ciesarik3 0:fb1547f2354e 344 */
Ciesarik3 0:fb1547f2354e 345
Ciesarik3 0:fb1547f2354e 346 /**
Ciesarik3 0:fb1547f2354e 347 * @}
Ciesarik3 0:fb1547f2354e 348 */
Ciesarik3 0:fb1547f2354e 349
Ciesarik3 0:fb1547f2354e 350 /**
Ciesarik3 0:fb1547f2354e 351 * @}
Ciesarik3 0:fb1547f2354e 352 */
Ciesarik3 0:fb1547f2354e 353
Ciesarik3 0:fb1547f2354e 354 /************************ (C) COPYRIGHT STMicroelectronics *****END OF FILE****/