639 lines
18 KiB
C
639 lines
18 KiB
C
/**************************************************************************************************
|
|
Filename: magnetometerservice.c
|
|
Revised: $Date: 2013-05-06 13:33:47 -0700 (Mon, 06 May 2013) $
|
|
Revision: $Revision: 34153 $
|
|
|
|
Description: Magnetometer Service
|
|
|
|
|
|
Copyright 2012-2013 Texas Instruments Incorporated. All rights reserved.
|
|
|
|
IMPORTANT: Your use of this Software is limited to those specific rights
|
|
granted under the terms of a software license agreement between the user
|
|
who downloaded the software, his/her employer (which must be your employer)
|
|
and Texas Instruments Incorporated (the "License"). You may not use this
|
|
Software unless you agree to abide by the terms of the License. The License
|
|
limits your use, and you acknowledge, that the Software may not be modified,
|
|
copied or distributed unless embedded on a Texas Instruments microcontroller
|
|
or used solely and exclusively in conjunction with a Texas Instruments radio
|
|
frequency transceiver, which is integrated into your product. Other than for
|
|
the foregoing purpose, you may not use, reproduce, copy, prepare derivative
|
|
works of, modify, distribute, perform, display or sell this Software and/or
|
|
its documentation for any purpose.
|
|
|
|
YOU FURTHER ACKNOWLEDGE AND AGREE THAT THE SOFTWARE AND DOCUMENTATION ARE
|
|
PROVIDED “AS IS” WITHOUT WARRANTY OF ANY KIND, EITHER EXPRESS OR IMPLIED,
|
|
INCLUDING WITHOUT LIMITATION, ANY WARRANTY OF MERCHANTABILITY, TITLE,
|
|
NON-INFRINGEMENT AND FITNESS FOR A PARTICULAR PURPOSE. IN NO EVENT SHALL
|
|
TEXAS INSTRUMENTS OR ITS LICENSORS BE LIABLE OR OBLIGATED UNDER CONTRACT,
|
|
NEGLIGENCE, STRICT LIABILITY, CONTRIBUTION, BREACH OF WARRANTY, OR OTHER
|
|
LEGAL EQUITABLE THEORY ANY DIRECT OR INDIRECT DAMAGES OR EXPENSES
|
|
INCLUDING BUT NOT LIMITED TO ANY INCIDENTAL, SPECIAL, INDIRECT, PUNITIVE
|
|
OR CONSEQUENTIAL DAMAGES, LOST PROFITS OR LOST DATA, COST OF PROCUREMENT
|
|
OF SUBSTITUTE GOODS, TECHNOLOGY, SERVICES, OR ANY CLAIMS BY THIRD PARTIES
|
|
(INCLUDING BUT NOT LIMITED TO ANY DEFENSE THEREOF), OR OTHER SIMILAR COSTS.
|
|
|
|
Should you have any questions regarding your right to use this Software,
|
|
contact Texas Instruments Incorporated at www.TI.com.
|
|
**************************************************************************************************/
|
|
|
|
/*********************************************************************
|
|
* INCLUDES
|
|
*/
|
|
#include "bcomdef.h"
|
|
#include "linkdb.h"
|
|
#include "gatt.h"
|
|
#include "gatt_uuid.h"
|
|
#include "gattservapp.h"
|
|
|
|
#include "magnetometerservice.h"
|
|
#include "st_util.h"
|
|
|
|
/*********************************************************************
|
|
* MACROS
|
|
*/
|
|
|
|
/*********************************************************************
|
|
* CONSTANTS
|
|
*/
|
|
|
|
/*********************************************************************
|
|
* TYPEDEFS
|
|
*/
|
|
|
|
/*********************************************************************
|
|
* GLOBAL VARIABLES
|
|
*/
|
|
|
|
// Magnetometer Service UUID
|
|
CONST uint8 magnetometerServUUID[TI_UUID_SIZE] =
|
|
{
|
|
TI_UUID(MAGNETOMETER_SERV_UUID),
|
|
};
|
|
|
|
// Magnetometer Characteristic value Data UUID
|
|
CONST uint8 magnetometerDataUUID[TI_UUID_SIZE] =
|
|
{
|
|
TI_UUID(MAGNETOMETER_DATA_UUID),
|
|
};
|
|
|
|
// Magnetometer Characteristic value Configuration UUID
|
|
CONST uint8 magnetometerCfgUUID[TI_UUID_SIZE] =
|
|
{
|
|
TI_UUID(MAGNETOMETER_CONF_UUID),
|
|
};
|
|
|
|
// Magnetometer Characteristic value Period UUID
|
|
CONST uint8 magnetometerPerUUID[TI_UUID_SIZE] =
|
|
{
|
|
TI_UUID(MAGNETOMETER_PERI_UUID),
|
|
};
|
|
|
|
/*********************************************************************
|
|
* EXTERNAL VARIABLES
|
|
*/
|
|
|
|
/*********************************************************************
|
|
* EXTERNAL FUNCTIONS
|
|
*/
|
|
|
|
/*********************************************************************
|
|
* LOCAL VARIABLES
|
|
*/
|
|
|
|
static magnetometerCBs_t *magnetometer_AppCBs = NULL;
|
|
|
|
/*********************************************************************
|
|
* Profile Attributes - variables
|
|
*/
|
|
|
|
// Magnetometer Profile Service attribute
|
|
static CONST gattAttrType_t magnetometerService = { TI_UUID_SIZE, magnetometerServUUID };
|
|
|
|
// Magnetometer Characteristic Properties
|
|
static uint8 magnetometerDataProps = GATT_PROP_READ | GATT_PROP_NOTIFY;
|
|
|
|
static uint8 magnetometerData[MAGNETOMETER_DATA_LEN] = { 0, 0, 0, 0, 0, 0};
|
|
|
|
// Magnetometer Characteristic Configuration
|
|
static gattCharCfg_t magnetometerDataConfig[GATT_MAX_NUM_CONN];
|
|
|
|
// Magnetometer Characteristic User Description
|
|
static uint8 magnetometerDataUserDesp[] = "Mag. Data";
|
|
|
|
// Magnetometer Characteristic Configuration Properties
|
|
static uint8 magnetometerCfgProps = GATT_PROP_READ | GATT_PROP_WRITE;
|
|
|
|
// Magnetometer Characteristic Configuration Value
|
|
static uint8 magnetometerCfg = 0;
|
|
|
|
// Magnetometer Characteristic Configuration User Description
|
|
static uint8 magnetometerCfgUserDesp[] = "Mag. Conf.";
|
|
|
|
// Magnetometer Characteristic Period Properties
|
|
static uint8 magnetometerPerProps = GATT_PROP_READ | GATT_PROP_WRITE;
|
|
|
|
// Magnetometer Characteristic Period Value
|
|
static uint8 magnetometerPer = 0;
|
|
|
|
// Magnetometer Characteristic Period User Description
|
|
static uint8 magnetometerPerUserDesp[] = "Mag. Period";
|
|
|
|
|
|
/*********************************************************************
|
|
* Profile Attributes - Table
|
|
*/
|
|
|
|
|
|
static gattAttribute_t sensorMagnetometerAttrTbl[] =
|
|
{
|
|
{
|
|
{ ATT_BT_UUID_SIZE, primaryServiceUUID }, /* type */
|
|
GATT_PERMIT_READ, /* permissions */
|
|
0, /* handle */
|
|
(uint8 *)&magnetometerService /* pValue */
|
|
},
|
|
|
|
// Characteristic Declaration
|
|
{
|
|
{ ATT_BT_UUID_SIZE, characterUUID },
|
|
GATT_PERMIT_READ,
|
|
0,
|
|
&magnetometerDataProps
|
|
},
|
|
|
|
// Characteristic Value "Data"
|
|
{
|
|
{ TI_UUID_SIZE, magnetometerDataUUID },
|
|
GATT_PERMIT_READ,
|
|
0,
|
|
magnetometerData
|
|
},
|
|
|
|
// Characteristic configuration
|
|
{
|
|
{ ATT_BT_UUID_SIZE, clientCharCfgUUID },
|
|
GATT_PERMIT_READ | GATT_PERMIT_WRITE,
|
|
0,
|
|
(uint8 *)magnetometerDataConfig
|
|
},
|
|
|
|
// Characteristic User Description
|
|
{
|
|
{ ATT_BT_UUID_SIZE, charUserDescUUID },
|
|
GATT_PERMIT_READ,
|
|
0,
|
|
magnetometerDataUserDesp
|
|
},
|
|
|
|
// Characteristic Declaration
|
|
{
|
|
{ ATT_BT_UUID_SIZE, characterUUID },
|
|
GATT_PERMIT_READ,
|
|
0,
|
|
&magnetometerCfgProps
|
|
},
|
|
|
|
// Characteristic Value "Configuration"
|
|
{
|
|
{ TI_UUID_SIZE, magnetometerCfgUUID },
|
|
GATT_PERMIT_READ | GATT_PERMIT_WRITE,
|
|
0,
|
|
&magnetometerCfg
|
|
},
|
|
|
|
// Characteristic User Description
|
|
{
|
|
{ ATT_BT_UUID_SIZE, charUserDescUUID },
|
|
GATT_PERMIT_READ,
|
|
0,
|
|
magnetometerCfgUserDesp
|
|
},
|
|
|
|
// Characteristic Declaration "Period"
|
|
{
|
|
{ ATT_BT_UUID_SIZE, characterUUID },
|
|
GATT_PERMIT_READ,
|
|
0,
|
|
&magnetometerPerProps
|
|
},
|
|
|
|
// Characteristic Value "Period"
|
|
{
|
|
{ TI_UUID_SIZE, magnetometerPerUUID },
|
|
GATT_PERMIT_READ | GATT_PERMIT_WRITE,
|
|
0,
|
|
&magnetometerPer
|
|
},
|
|
|
|
// Characteristic User Description "Period"
|
|
{
|
|
{ ATT_BT_UUID_SIZE, charUserDescUUID },
|
|
GATT_PERMIT_READ,
|
|
0,
|
|
magnetometerPerUserDesp
|
|
},
|
|
};
|
|
|
|
|
|
/*********************************************************************
|
|
* LOCAL FUNCTIONS
|
|
*/
|
|
static uint8 magnetometer_ReadAttrCB( uint16 connHandle, gattAttribute_t *pAttr,
|
|
uint8 *pValue, uint8 *pLen, uint16 offset, uint8 maxLen );
|
|
static bStatus_t magnetometer_WriteAttrCB( uint16 connHandle, gattAttribute_t *pAttr,
|
|
uint8 *pValue, uint8 len, uint16 offset );
|
|
static void magnetometer_HandleConnStatusCB( uint16 connHandle, uint8 changeType );
|
|
|
|
/*********************************************************************
|
|
* PROFILE CALLBACKS
|
|
*/
|
|
// Magnetometer Profile Service Callbacks
|
|
CONST gattServiceCBs_t magnetometerCBs =
|
|
{
|
|
magnetometer_ReadAttrCB, // Read callback function pointer
|
|
magnetometer_WriteAttrCB, // Write callback function pointer
|
|
NULL // Authorization callback function pointer
|
|
};
|
|
|
|
/*********************************************************************
|
|
* PUBLIC FUNCTIONS
|
|
*/
|
|
|
|
/*********************************************************************
|
|
* @fn Magnetometer_AddService
|
|
*
|
|
* @brief Initializes the Sensor Profile service by registering
|
|
* GATT attributes with the GATT server.
|
|
*
|
|
* @param services - services to add. This is a bit map and can
|
|
* contain more than one service.
|
|
*
|
|
* @return Success or Failure
|
|
*/
|
|
bStatus_t Magnetometer_AddService( uint32 services )
|
|
{
|
|
uint8 status = SUCCESS;
|
|
|
|
GATTServApp_InitCharCfg( INVALID_CONNHANDLE, magnetometerDataConfig );
|
|
|
|
// Register with Link DB to receive link status change callback
|
|
VOID linkDB_Register( magnetometer_HandleConnStatusCB );
|
|
|
|
if ( services & MAGNETOMETER_SERVICE )
|
|
{
|
|
// Register GATT attribute list and CBs with GATT Server App
|
|
status = GATTServApp_RegisterService( sensorMagnetometerAttrTbl,
|
|
GATT_NUM_ATTRS( sensorMagnetometerAttrTbl ),
|
|
&magnetometerCBs );
|
|
}
|
|
|
|
return ( status );
|
|
}
|
|
|
|
|
|
/*********************************************************************
|
|
* @fn Magnetometer_RegisterAppCBs
|
|
*
|
|
* @brief Registers the application callback function. Only call
|
|
* this function once.
|
|
*
|
|
* @param callbacks - pointer to application callbacks.
|
|
*
|
|
* @return SUCCESS or bleAlreadyInRequestedMode
|
|
*/
|
|
bStatus_t Magnetometer_RegisterAppCBs( magnetometerCBs_t *appCallbacks )
|
|
{
|
|
if ( magnetometer_AppCBs == NULL )
|
|
{
|
|
if ( appCallbacks != NULL )
|
|
{
|
|
magnetometer_AppCBs = appCallbacks;
|
|
}
|
|
|
|
return ( SUCCESS );
|
|
}
|
|
|
|
return ( bleAlreadyInRequestedMode );
|
|
}
|
|
|
|
|
|
/*********************************************************************
|
|
* @fn Magnetometer_SetParameter
|
|
*
|
|
* @brief Set a Sensor Profile parameter.
|
|
*
|
|
* @param param - Profile parameter ID
|
|
* @param len - length of data to right
|
|
* @param value - pointer to data to write. This is dependent on
|
|
* the parameter ID and WILL be cast to the appropriate
|
|
* data type (example: data type of uint16 will be cast to
|
|
* uint16 pointer).
|
|
*
|
|
* @return bStatus_t
|
|
*/
|
|
bStatus_t Magnetometer_SetParameter( uint8 param, uint8 len, void *value )
|
|
{
|
|
bStatus_t ret = SUCCESS;
|
|
|
|
switch ( param )
|
|
{
|
|
case MAGNETOMETER_DATA:
|
|
if ( len == MAGNETOMETER_DATA_LEN )
|
|
{
|
|
VOID osal_memcpy( magnetometerData, value, MAGNETOMETER_DATA_LEN );
|
|
// See if Notification has been enabled
|
|
GATTServApp_ProcessCharCfg( magnetometerDataConfig, magnetometerData, FALSE,
|
|
sensorMagnetometerAttrTbl, GATT_NUM_ATTRS( sensorMagnetometerAttrTbl ),
|
|
INVALID_TASK_ID );
|
|
}
|
|
else
|
|
{
|
|
ret = bleInvalidRange;
|
|
}
|
|
break;
|
|
|
|
case MAGNETOMETER_CONF:
|
|
if ( len == sizeof ( uint8 ) )
|
|
{
|
|
magnetometerCfg = *((uint8*)value);
|
|
}
|
|
else
|
|
{
|
|
ret = bleInvalidRange;
|
|
}
|
|
break;
|
|
|
|
case MAGNETOMETER_PERI:
|
|
if ( len == sizeof ( uint8 ) )
|
|
{
|
|
magnetometerPer = *((uint8*)value);
|
|
}
|
|
else
|
|
{
|
|
ret = bleInvalidRange;
|
|
}
|
|
break;
|
|
|
|
default:
|
|
break;
|
|
}
|
|
|
|
return ( ret );
|
|
}
|
|
|
|
/*********************************************************************
|
|
* @fn Magnetometer_GetParameter
|
|
*
|
|
* @brief Get a Sensor Profile parameter.
|
|
*
|
|
* @param param - Profile parameter ID
|
|
* @param value - pointer to data to put. This is dependent on
|
|
* the parameter ID and WILL be cast to the appropriate
|
|
* data type (example: data type of uint16 will be cast to
|
|
* uint16 pointer).
|
|
*
|
|
* @return bStatus_t
|
|
*/
|
|
bStatus_t Magnetometer_GetParameter( uint8 param, void *value )
|
|
{
|
|
bStatus_t ret = SUCCESS;
|
|
|
|
switch ( param )
|
|
{
|
|
case MAGNETOMETER_DATA:
|
|
VOID osal_memcpy( value, magnetometerData, MAGNETOMETER_DATA_LEN );
|
|
break;
|
|
|
|
case MAGNETOMETER_CONF:
|
|
*((uint8*)value) = magnetometerCfg;
|
|
break;
|
|
|
|
case MAGNETOMETER_PERI:
|
|
*((uint8*)value) = magnetometerPer;
|
|
break;
|
|
}
|
|
|
|
return ( ret );
|
|
}
|
|
|
|
/*********************************************************************
|
|
* @fn magnetometer_ReadAttrCB
|
|
*
|
|
* @brief Read an attribute.
|
|
*
|
|
* @param connHandle - connection message was received on
|
|
* @param pAttr - pointer to attribute
|
|
* @param pValue - pointer to data to be read
|
|
* @param pLen - length of data to be read
|
|
* @param offset - offset of the first octet to be read
|
|
* @param maxLen - maximum length of data to be read
|
|
*
|
|
* @return Success or Failure
|
|
*/
|
|
static uint8 magnetometer_ReadAttrCB( uint16 connHandle, gattAttribute_t *pAttr,
|
|
uint8 *pValue, uint8 *pLen, uint16 offset, uint8 maxLen )
|
|
{
|
|
uint16 uuid;
|
|
bStatus_t status = SUCCESS;
|
|
|
|
// If attribute permissions require authorization to read, return error
|
|
if ( gattPermitAuthorRead( pAttr->permissions ) )
|
|
{
|
|
// Insufficient authorization
|
|
return ( ATT_ERR_INSUFFICIENT_AUTHOR );
|
|
}
|
|
|
|
// Make sure it's not a blob operation (no attributes in the profile are long)
|
|
if ( offset > 0 )
|
|
{
|
|
return ( ATT_ERR_ATTR_NOT_LONG );
|
|
}
|
|
|
|
if (utilExtractUuid16(pAttr,&uuid) == FAILURE)
|
|
{
|
|
// Invalid handle
|
|
*pLen = 0;
|
|
return ATT_ERR_INVALID_HANDLE;
|
|
}
|
|
|
|
switch ( uuid )
|
|
{
|
|
// No need for "GATT_SERVICE_UUID" or "GATT_CLIENT_CHAR_CFG_UUID" cases;
|
|
// gattserverapp handles those reads
|
|
case MAGNETOMETER_DATA_UUID:
|
|
*pLen = MAGNETOMETER_DATA_LEN;
|
|
VOID osal_memcpy( pValue, pAttr->pValue, MAGNETOMETER_DATA_LEN );
|
|
break;
|
|
|
|
case MAGNETOMETER_CONF_UUID:
|
|
*pLen = 1;
|
|
pValue[0] = *pAttr->pValue;
|
|
break;
|
|
|
|
case MAGNETOMETER_PERI_UUID:
|
|
*pLen = 1;
|
|
pValue[0] = *pAttr->pValue;
|
|
break;
|
|
|
|
default:
|
|
*pLen = 0;
|
|
status = ATT_ERR_ATTR_NOT_FOUND;
|
|
break;
|
|
}
|
|
|
|
return ( status );
|
|
}
|
|
|
|
/*********************************************************************
|
|
* @fn magnetometer_WriteAttrCB
|
|
*
|
|
* @brief Validate attribute data prior to a write operation
|
|
*
|
|
* @param connHandle - connection message was received on
|
|
* @param pAttr - pointer to attribute
|
|
* @param pValue - pointer to data to be written
|
|
* @param len - length of data
|
|
* @param offset - offset of the first octet to be written
|
|
*
|
|
* @return Success or Failure
|
|
*/
|
|
static bStatus_t magnetometer_WriteAttrCB( uint16 connHandle, gattAttribute_t *pAttr,
|
|
uint8 *pValue, uint8 len, uint16 offset )
|
|
{
|
|
uint16 uuid;
|
|
bStatus_t status = SUCCESS;
|
|
uint8 notifyApp = 0xFF;
|
|
|
|
// If attribute permissions require authorization to write, return error
|
|
if ( gattPermitAuthorWrite( pAttr->permissions ) )
|
|
{
|
|
// Insufficient authorization
|
|
return ( ATT_ERR_INSUFFICIENT_AUTHOR );
|
|
}
|
|
|
|
if (utilExtractUuid16(pAttr,&uuid) == FAILURE)
|
|
{
|
|
// Invalid handle
|
|
return ATT_ERR_INVALID_HANDLE;
|
|
}
|
|
|
|
switch ( uuid )
|
|
{
|
|
case MAGNETOMETER_DATA_UUID:
|
|
//Should not get here
|
|
break;
|
|
|
|
case MAGNETOMETER_CONF_UUID:
|
|
// Validate the value
|
|
// Make sure it's not a blob oper
|
|
if ( offset == 0 )
|
|
{
|
|
if ( len != 1 )
|
|
{
|
|
status = ATT_ERR_INVALID_VALUE_SIZE;
|
|
}
|
|
}
|
|
else
|
|
{
|
|
status = ATT_ERR_ATTR_NOT_LONG;
|
|
}
|
|
|
|
// Write the value
|
|
if ( status == SUCCESS )
|
|
{
|
|
uint8 *pCurValue = (uint8 *)pAttr->pValue;
|
|
*pCurValue = pValue[0];
|
|
|
|
if( pAttr->pValue == &magnetometerCfg )
|
|
{
|
|
notifyApp = MAGNETOMETER_CONF;
|
|
}
|
|
}
|
|
break;
|
|
|
|
case MAGNETOMETER_PERI_UUID:
|
|
// Validate the value
|
|
// Make sure it's not a blob oper
|
|
if ( offset == 0 )
|
|
{
|
|
if ( len != 1 )
|
|
{
|
|
status = ATT_ERR_INVALID_VALUE_SIZE;
|
|
}
|
|
}
|
|
else
|
|
{
|
|
status = ATT_ERR_ATTR_NOT_LONG;
|
|
}
|
|
|
|
// Write the value
|
|
if ( status == SUCCESS )
|
|
{
|
|
if (pValue[0]>=(MAGNETOMETER_PERIOD_MIN/MAGNETOMETER_TIME_UNIT))
|
|
{
|
|
|
|
uint8 *pCurValue = (uint8 *)pAttr->pValue;
|
|
*pCurValue = pValue[0];
|
|
|
|
if( pAttr->pValue == &magnetometerPer)
|
|
{
|
|
notifyApp = MAGNETOMETER_PERI;
|
|
}
|
|
}
|
|
else
|
|
{
|
|
status = ATT_ERR_INVALID_VALUE;
|
|
}
|
|
}
|
|
break;
|
|
|
|
case GATT_CLIENT_CHAR_CFG_UUID:
|
|
status = GATTServApp_ProcessCCCWriteReq( connHandle, pAttr, pValue, len,
|
|
offset, GATT_CLIENT_CFG_NOTIFY );
|
|
break;
|
|
|
|
default:
|
|
// Should never get here!
|
|
status = ATT_ERR_ATTR_NOT_FOUND;
|
|
break;
|
|
}
|
|
|
|
// If a charactersitic value changed then callback function to notify application of change
|
|
if ( (notifyApp != 0xFF ) && magnetometer_AppCBs && magnetometer_AppCBs->pfnMagnetometerChange )
|
|
{
|
|
magnetometer_AppCBs->pfnMagnetometerChange( notifyApp );
|
|
}
|
|
|
|
return ( status );
|
|
}
|
|
|
|
/*********************************************************************
|
|
* @fn magnetometer_HandleConnStatusCB
|
|
*
|
|
* @brief Sensor Profile link status change handler function.
|
|
*
|
|
* @param connHandle - connection handle
|
|
* @param changeType - type of change
|
|
*
|
|
* @return none
|
|
*/
|
|
static void magnetometer_HandleConnStatusCB( uint16 connHandle, uint8 changeType )
|
|
{
|
|
// Make sure this is not loopback connection
|
|
if ( connHandle != LOOPBACK_CONNHANDLE )
|
|
{
|
|
// Reset Client Char Config if connection has dropped
|
|
if ( ( changeType == LINKDB_STATUS_UPDATE_REMOVED ) ||
|
|
( ( changeType == LINKDB_STATUS_UPDATE_STATEFLAGS ) &&
|
|
( !linkDB_Up( connHandle ) ) ) )
|
|
{
|
|
GATTServApp_InitCharCfg( connHandle, magnetometerDataConfig );
|
|
}
|
|
}
|
|
}
|
|
|
|
|
|
/*********************************************************************
|
|
*********************************************************************/
|