Trinity Devboard PCB V1.0 Firmware. FreeRTOS is setup and the MCU reads IMU data over SPI fand Magnetometer data over I2C, each with a seperate task. Sensordata is then run though MadgwickAHRS and send over USB as serial packet data to use in trinity visualizer. Bare minimum functionality works and is replicated from the first prototype.
This commit is contained in:
@@ -0,0 +1,54 @@
|
||||
|
||||
/**
|
||||
******************************************************************************
|
||||
* @file common_blesvc.h
|
||||
* @author MCD Application Team
|
||||
* @brief Header for ble modules
|
||||
******************************************************************************
|
||||
* @attention
|
||||
*
|
||||
* Copyright (c) 2018-2021 STMicroelectronics.
|
||||
* All rights reserved.
|
||||
*
|
||||
* This software is licensed under terms that can be found in the LICENSE file
|
||||
* in the root directory of this software component.
|
||||
* If no LICENSE file comes with this software, it is provided AS-IS.
|
||||
*
|
||||
******************************************************************************
|
||||
*/
|
||||
|
||||
|
||||
/* Define to prevent recursive inclusion -------------------------------------*/
|
||||
#ifndef __COMMON_BLESVC_H
|
||||
#define __COMMON_BLESVC_H
|
||||
|
||||
#ifdef __cplusplus
|
||||
extern "C" {
|
||||
#endif
|
||||
|
||||
/* Includes ------------------------------------------------------------------*/
|
||||
#include "ble_common.h"
|
||||
#include "ble.h"
|
||||
#include "dbg_trace.h"
|
||||
|
||||
|
||||
|
||||
/* Exported types ------------------------------------------------------------*/
|
||||
typedef enum
|
||||
{
|
||||
COMSVC_Notification = ( 1 << 0 ),
|
||||
COMSVC_Indication = ( 1 << 1 ),
|
||||
} COMSVC_ClientCharConfMask_t;
|
||||
|
||||
/* Exported constants --------------------------------------------------------*/
|
||||
/* External variables --------------------------------------------------------*/
|
||||
/* Exported macros -----------------------------------------------------------*/
|
||||
|
||||
|
||||
#ifdef __cplusplus
|
||||
}
|
||||
#endif
|
||||
|
||||
#endif /*__COMMON_BLESVC_H */
|
||||
|
||||
|
||||
@@ -0,0 +1,330 @@
|
||||
/**
|
||||
******************************************************************************
|
||||
* @file svc_ctl.c
|
||||
* @author MCD Application Team
|
||||
* @brief BLE Controller
|
||||
******************************************************************************
|
||||
* @attention
|
||||
*
|
||||
* Copyright (c) 2018-2021 STMicroelectronics.
|
||||
* All rights reserved.
|
||||
*
|
||||
* This software is licensed under terms that can be found in the LICENSE file
|
||||
* in the root directory of this software component.
|
||||
* If no LICENSE file comes with this software, it is provided AS-IS.
|
||||
*
|
||||
******************************************************************************
|
||||
*/
|
||||
|
||||
|
||||
/* Includes ------------------------------------------------------------------*/
|
||||
#include "common_blesvc.h"
|
||||
#include "cmsis_compiler.h"
|
||||
|
||||
/* Private typedef -----------------------------------------------------------*/
|
||||
typedef struct
|
||||
{
|
||||
#if (BLE_CFG_SVC_MAX_NBR_CB > 0)
|
||||
SVC_CTL_p_EvtHandler_t SVCCTL__SvcHandlerTab[BLE_CFG_SVC_MAX_NBR_CB];
|
||||
#endif
|
||||
uint8_t NbreOfRegisteredHandler;
|
||||
} SVCCTL_EvtHandler_t;
|
||||
|
||||
typedef struct
|
||||
{
|
||||
#if (BLE_CFG_CLT_MAX_NBR_CB > 0)
|
||||
SVC_CTL_p_EvtHandler_t SVCCTL_CltHandlerTable[BLE_CFG_CLT_MAX_NBR_CB];
|
||||
#endif
|
||||
uint8_t NbreOfRegisteredHandler;
|
||||
} SVCCTL_CltHandler_t;
|
||||
|
||||
/* Private defines -----------------------------------------------------------*/
|
||||
#define SVCCTL_EGID_EVT_MASK 0xFF00
|
||||
#define SVCCTL_GATT_EVT_TYPE 0x0C00
|
||||
#define SVCCTL_GAP_DEVICE_NAME_LENGTH 7
|
||||
|
||||
/* Private macros ------------------------------------------------------------*/
|
||||
/* Private variables ---------------------------------------------------------*/
|
||||
/**
|
||||
* START of Section BLE_DRIVER_CONTEXT
|
||||
*/
|
||||
|
||||
PLACE_IN_SECTION("BLE_DRIVER_CONTEXT") SVCCTL_EvtHandler_t SVCCTL_EvtHandler;
|
||||
PLACE_IN_SECTION("BLE_DRIVER_CONTEXT") SVCCTL_CltHandler_t SVCCTL_CltHandler;
|
||||
|
||||
/**
|
||||
* END of Section BLE_DRIVER_CONTEXT
|
||||
*/
|
||||
|
||||
/* Private functions ----------------------------------------------------------*/
|
||||
/* Weak functions ----------------------------------------------------------*/
|
||||
void BVOPUS_STM_Init(void);
|
||||
|
||||
__WEAK void BAS_Init( void )
|
||||
{
|
||||
return;
|
||||
}
|
||||
|
||||
__WEAK void BLS_Init( void )
|
||||
{
|
||||
return;
|
||||
}
|
||||
__WEAK void CRS_STM_Init( void )
|
||||
{
|
||||
return;
|
||||
}
|
||||
__WEAK void DIS_Init( void )
|
||||
{
|
||||
return;
|
||||
}
|
||||
__WEAK void EDS_STM_Init( void )
|
||||
{
|
||||
return;
|
||||
}
|
||||
__WEAK void HIDS_Init( void )
|
||||
{
|
||||
return;
|
||||
}
|
||||
__WEAK void HRS_Init( void )
|
||||
{
|
||||
return;
|
||||
}
|
||||
__WEAK void HTS_Init( void )
|
||||
{
|
||||
return;
|
||||
}
|
||||
__WEAK void IAS_Init( void )
|
||||
{
|
||||
return;
|
||||
}
|
||||
__WEAK void LLS_Init( void )
|
||||
{
|
||||
return;
|
||||
}
|
||||
__WEAK void TPS_Init( void )
|
||||
{
|
||||
return;
|
||||
}
|
||||
__WEAK void MOTENV_STM_Init( void )
|
||||
{
|
||||
return;
|
||||
}
|
||||
__WEAK void P2PS_STM_Init( void )
|
||||
{
|
||||
return;
|
||||
}
|
||||
__WEAK void ZDD_STM_Init( void )
|
||||
{
|
||||
return;
|
||||
}
|
||||
__WEAK void OTAS_STM_Init( void )
|
||||
{
|
||||
return;
|
||||
}
|
||||
__WEAK void MESH_Init( void )
|
||||
{
|
||||
return;
|
||||
}
|
||||
__WEAK void BVOPUS_STM_Init( void )
|
||||
{
|
||||
return;
|
||||
}
|
||||
__WEAK void SVCCTL_InitCustomSvc( void )
|
||||
{
|
||||
return;
|
||||
}
|
||||
|
||||
/* Functions Definition ------------------------------------------------------*/
|
||||
|
||||
void SVCCTL_Init( void )
|
||||
{
|
||||
|
||||
/**
|
||||
* Initialize the number of registered Handler
|
||||
*/
|
||||
SVCCTL_EvtHandler.NbreOfRegisteredHandler = 0;
|
||||
SVCCTL_CltHandler.NbreOfRegisteredHandler = 0;
|
||||
|
||||
/**
|
||||
* Add and Initialize requested services
|
||||
*/
|
||||
SVCCTL_SvcInit();
|
||||
|
||||
return;
|
||||
}
|
||||
|
||||
__WEAK void SVCCTL_SvcInit(void)
|
||||
{
|
||||
BAS_Init();
|
||||
|
||||
BLS_Init();
|
||||
|
||||
CRS_STM_Init();
|
||||
|
||||
DIS_Init();
|
||||
|
||||
EDS_STM_Init();
|
||||
|
||||
HIDS_Init();
|
||||
|
||||
HRS_Init();
|
||||
|
||||
HTS_Init();
|
||||
|
||||
IAS_Init();
|
||||
|
||||
LLS_Init();
|
||||
|
||||
TPS_Init();
|
||||
|
||||
MOTENV_STM_Init();
|
||||
|
||||
P2PS_STM_Init();
|
||||
|
||||
ZDD_STM_Init();
|
||||
|
||||
OTAS_STM_Init();
|
||||
|
||||
BVOPUS_STM_Init();
|
||||
|
||||
MESH_Init();
|
||||
|
||||
SVCCTL_InitCustomSvc();
|
||||
|
||||
return;
|
||||
}
|
||||
|
||||
/**
|
||||
* @brief BLE Controller initialization
|
||||
* @param None
|
||||
* @retval None
|
||||
*/
|
||||
void SVCCTL_RegisterSvcHandler( SVC_CTL_p_EvtHandler_t pfBLE_SVC_Service_Event_Handler )
|
||||
{
|
||||
#if (BLE_CFG_SVC_MAX_NBR_CB > 0)
|
||||
SVCCTL_EvtHandler.SVCCTL__SvcHandlerTab[SVCCTL_EvtHandler.NbreOfRegisteredHandler] = pfBLE_SVC_Service_Event_Handler;
|
||||
SVCCTL_EvtHandler.NbreOfRegisteredHandler++;
|
||||
#else
|
||||
(void)(pfBLE_SVC_Service_Event_Handler);
|
||||
#endif
|
||||
|
||||
return;
|
||||
}
|
||||
|
||||
/**
|
||||
* @brief BLE Controller initialization
|
||||
* @param None
|
||||
* @retval None
|
||||
*/
|
||||
void SVCCTL_RegisterCltHandler( SVC_CTL_p_EvtHandler_t pfBLE_SVC_Client_Event_Handler )
|
||||
{
|
||||
#if (BLE_CFG_CLT_MAX_NBR_CB > 0)
|
||||
SVCCTL_CltHandler.SVCCTL_CltHandlerTable[SVCCTL_CltHandler.NbreOfRegisteredHandler] = pfBLE_SVC_Client_Event_Handler;
|
||||
SVCCTL_CltHandler.NbreOfRegisteredHandler++;
|
||||
#else
|
||||
(void)(pfBLE_SVC_Client_Event_Handler);
|
||||
#endif
|
||||
|
||||
return;
|
||||
}
|
||||
|
||||
__WEAK SVCCTL_UserEvtFlowStatus_t SVCCTL_UserEvtRx( void *pckt )
|
||||
{
|
||||
hci_event_pckt *event_pckt;
|
||||
evt_blecore_aci *blecore_evt;
|
||||
SVCCTL_EvtAckStatus_t event_notification_status;
|
||||
SVCCTL_UserEvtFlowStatus_t return_status;
|
||||
uint8_t index;
|
||||
|
||||
event_pckt = (hci_event_pckt*) ((hci_uart_pckt *) pckt)->data;
|
||||
event_notification_status = SVCCTL_EvtNotAck;
|
||||
|
||||
switch (event_pckt->evt)
|
||||
{
|
||||
case HCI_VENDOR_SPECIFIC_DEBUG_EVT_CODE:
|
||||
{
|
||||
blecore_evt = (evt_blecore_aci*) event_pckt->data;
|
||||
|
||||
switch ((blecore_evt->ecode) & SVCCTL_EGID_EVT_MASK)
|
||||
{
|
||||
case SVCCTL_GATT_EVT_TYPE:
|
||||
#if (BLE_CFG_SVC_MAX_NBR_CB > 0)
|
||||
/* For Service event handler */
|
||||
for (index = 0; index < SVCCTL_EvtHandler.NbreOfRegisteredHandler; index++)
|
||||
{
|
||||
event_notification_status = SVCCTL_EvtHandler.SVCCTL__SvcHandlerTab[index](pckt);
|
||||
/**
|
||||
* When a GATT event has been acknowledged by a Service, there is no need to call the other registered handlers
|
||||
* a GATT event is relevant for only one Service
|
||||
*/
|
||||
if (event_notification_status != SVCCTL_EvtNotAck)
|
||||
{
|
||||
/**
|
||||
* The event has been managed. The Event processing should be stopped
|
||||
*/
|
||||
break;
|
||||
}
|
||||
}
|
||||
#endif
|
||||
#if (BLE_CFG_CLT_MAX_NBR_CB > 0)
|
||||
/* For Client event handler */
|
||||
event_notification_status = SVCCTL_EvtNotAck;
|
||||
for(index = 0; index <SVCCTL_CltHandler.NbreOfRegisteredHandler; index++)
|
||||
{
|
||||
event_notification_status = SVCCTL_CltHandler.SVCCTL_CltHandlerTable[index](pckt);
|
||||
/**
|
||||
* When a GATT event has been acknowledged by a Client, there is no need to call the other registered handlers
|
||||
* a GATT event is relevant for only one Client
|
||||
*/
|
||||
if (event_notification_status != SVCCTL_EvtNotAck)
|
||||
{
|
||||
/**
|
||||
* The event has been managed. The Event processing should be stopped
|
||||
*/
|
||||
break;
|
||||
}
|
||||
}
|
||||
#endif
|
||||
break;
|
||||
|
||||
default:
|
||||
break;
|
||||
}
|
||||
}
|
||||
break; /* HCI_HCI_VENDOR_SPECIFIC_DEBUG_EVT_CODE_SPECIFIC */
|
||||
|
||||
default:
|
||||
break;
|
||||
}
|
||||
|
||||
/**
|
||||
* When no registered handlers (either Service or Client) has acknowledged the GATT event, it is reported to the application
|
||||
* a GAP event is always reported to the application.
|
||||
*/
|
||||
switch (event_notification_status)
|
||||
{
|
||||
case SVCCTL_EvtNotAck:
|
||||
/**
|
||||
* The event has NOT been managed.
|
||||
* It shall be passed to the application for processing
|
||||
*/
|
||||
return_status = SVCCTL_App_Notification(pckt);
|
||||
break;
|
||||
|
||||
case SVCCTL_EvtAckFlowEnable:
|
||||
return_status = SVCCTL_UserEvtFlowEnable;
|
||||
break;
|
||||
|
||||
case SVCCTL_EvtAckFlowDisable:
|
||||
return_status = SVCCTL_UserEvtFlowDisable;
|
||||
break;
|
||||
|
||||
default:
|
||||
return_status = SVCCTL_UserEvtFlowEnable;
|
||||
break;
|
||||
}
|
||||
|
||||
return (return_status);
|
||||
}
|
||||
|
||||
|
||||
Reference in New Issue
Block a user