/********************************************************************* * @fn readMagData * * @brief Read magnetometer data * * @param none * * @return none */ static void readMagData( void ) { uint8 mData[MAGNETOMETER_DATA_LEN]; if (HalMagRead(mData)) { Magnetometer_SetParameter(SENSOR_DATA, MAGNETOMETER_DATA_LEN, mData); } }
/********************************************************************* * @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; // VB case BED_SERV_UUID: Bed_SetParameter( paramID, paramLen, pData); break; default: // Should not get here break; } osal_mem_free(pData); }