/*********************************************************************
* @fn resetCharacteristicValue
*
* @brief Initialize a characteristic value to zero
*
* @param servID - service ID (UUID)
*
* @param paramID - parameter ID of the value is to be cleared
*
* @param vakue - value to initialise with
*
* @param paramLen - length of the parameter
*
* @return none
*/
static void resetCharacteristicValue(uint16 servUuid, uint8 paramID, uint8 value, uint8 paramLen)
{
uint8* pData = osal_mem_alloc(paramLen);
if (pData == NULL)
{
return;
}
osal_memset(pData,value,paramLen);
switch(servUuid)
{
//case IRTEMPERATURE_SERV_UUID:
// IRTemp_SetParameter( paramID, paramLen, pData);
// break;
case ACCELEROMETER_SERV_UUID:
Accel_SetParameter( paramID, paramLen, pData);
break;
//case MAGNETOMETER_SERV_UUID:
// Magnetometer_SetParameter( paramID, paramLen, pData);
// break;
//case HUMIDITY_SERV_UUID:
// Humidity_SetParameter( paramID, paramLen, pData);
// break;
//case BAROMETER_SERV_UUID:
// Barometer_SetParameter( paramID, paramLen, pData);
// break;
case GYROSCOPE_SERV_UUID:
Gyro_SetParameter( paramID, paramLen, pData);
break;
default:
// Should not get here
break;
}
osal_mem_free(pData);
}
/*********************************************************************
* @fn readGyroData
*
* @brief Read gyroscope data
*
* @param none
*
* @return none
*/
static void readGyroData( void )
{
uint8 gData[GYROSCOPE_DATA_LEN];
if (HalGyroRead(gData))
{
Gyro_SetParameter( SENSOR_DATA, GYROSCOPE_DATA_LEN, gData);
}
}
/*********************************************************************
* @fn readGyroData
*
* @brief Read gyroscope data
*
* @param none
*
* @return none
*/
static void readGyroData( void )
{
uint8 aData[ACCELEROMETER_DATA_LEN];
uint8 gData[GYROSCOPE_DATA_LEN];
//GAPRole_SendUpdateParam( DEFAULT_DESIRED_MIN_CONN_INTERVAL, DEFAULT_DESIRED_MAX_CONN_INTERVAL, DEFAULT_DESIRED_CONN_TIMEOUT, DEFAULT_DESIRED_CONN_TIMEOUT, GAPROLE_TERMINATE_LINK);
if (HalGyroRead(aData,gData))
{
Accel_SetParameter( ACCELEROMETER_DATA, ACCELEROMETER_DATA_LEN, aData);
Gyro_SetParameter( GYROSCOPE_DATA, GYROSCOPE_DATA_LEN, gData);
}
}
