diff options
Diffstat (limited to 'src/direct_bt/GATTNumbers.cpp')
| -rw-r--r-- | src/direct_bt/GATTNumbers.cpp | 507 |
1 files changed, 507 insertions, 0 deletions
diff --git a/src/direct_bt/GATTNumbers.cpp b/src/direct_bt/GATTNumbers.cpp new file mode 100644 index 00000000..970d94e2 --- /dev/null +++ b/src/direct_bt/GATTNumbers.cpp @@ -0,0 +1,507 @@ +/* + * Author: Sven Gothel <[email protected]> + * Copyright (c) 2020 Gothel Software e.K. + * Copyright (c) 2020 ZAFENA AB + * + * Permission is hereby granted, free of charge, to any person obtaining + * a copy of this software and associated documentation files (the + * "Software"), to deal in the Software without restriction, including + * without limitation the rights to use, copy, modify, merge, publish, + * distribute, sublicense, and/or sell copies of the Software, and to + * permit persons to whom the Software is furnished to do so, subject to + * the following conditions: + * + * The above copyright notice and this permission notice shall be + * included in all copies or substantial portions of the Software. + * + * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, + * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF + * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND + * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE + * LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION + * OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION + * WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE. + */ + +#include <cstring> +#include <string> +#include <memory> +#include <cstdint> +#include <vector> +#include <cstdio> + +#include <algorithm> + +#include "GATTNumbers.hpp" + +#include "dbt_debug.hpp" + +using namespace direct_bt; + +/** https://www.bluetooth.com/wp-content/uploads/Sitecore-Media-Library/Gatt/Xml/Services/org.bluetooth.service.generic_access.xml */ +const GattServiceCharacteristic direct_bt::GATT_GENERIC_ACCESS_SRVC = { GENERIC_ACCESS, + { { DEVICE_NAME, Mandatory, + // GattCharacteristicPropertySpec[9]: + { { Read, Mandatory }, + { WriteWithAck, Optional }, { WriteNoAck, Excluded }, { AuthSignedWrite, Excluded }, { ReliableWriteExt, Excluded }, + { Notify, Excluded }, { Indicate, Excluded }, { AuxWriteExt, Excluded }, { Broadcast, Excluded } }, + // GattClientCharacteristicConfigSpec: + { Excluded, { Read, Excluded}, { WriteWithAck, Excluded } } + }, + { APPEARANCE, Mandatory, + // GattCharacteristicPropertySpec[9]: + { { Read, Mandatory }, + { WriteWithAck, Excluded }, { WriteNoAck, Excluded }, { AuthSignedWrite, Excluded }, { ReliableWriteExt, Excluded }, + { Notify, Excluded }, { Indicate, Excluded }, { AuxWriteExt, Excluded }, { Broadcast, Excluded } }, + // GattClientCharacteristicConfigSpec: + { Excluded, { Read, Excluded}, { WriteWithAck, Excluded } } + }, + { PERIPHERAL_PRIVACY_FLAG, Optional, + // GattCharacteristicPropertySpec[9]: + { { Read, Mandatory }, + { WriteWithAck, Excluded }, { WriteNoAck, C1 }, { AuthSignedWrite, Excluded }, { ReliableWriteExt, Excluded }, + { Notify, Excluded }, { Indicate, Excluded }, { AuxWriteExt, Excluded }, { Broadcast, Excluded } }, + // GattClientCharacteristicConfigSpec: + { Excluded, { Read, Excluded}, { WriteWithAck, Excluded } } + }, + { RECONNECTION_ADDRESS, Conditional, + // GattCharacteristicPropertySpec[9]: + { { Read, Excluded }, + { WriteWithAck, Mandatory }, { WriteNoAck, Excluded }, { AuthSignedWrite, Excluded }, { ReliableWriteExt, Excluded }, + { Notify, Excluded }, { Indicate, Excluded }, { AuxWriteExt, Excluded }, { Broadcast, Excluded } }, + // GattClientCharacteristicConfigSpec: + { Excluded, { Read, Excluded}, { WriteWithAck, Excluded } } + }, + { PERIPHERAL_PREFERRED_CONNECTION_PARAMETERS, Optional, + // GattCharacteristicPropertySpec[9]: + { { Read, Mandatory }, + { WriteWithAck, Excluded }, { WriteNoAck, Excluded }, { AuthSignedWrite, Excluded }, { ReliableWriteExt, Excluded }, + { Notify, Excluded }, { Indicate, Excluded }, { AuxWriteExt, Excluded }, { Broadcast, Excluded } }, + // GattClientCharacteristicConfigSpec: + { Excluded, { Read, Excluded}, { WriteWithAck, Excluded } } + }, + } }; + +/** https://www.bluetooth.com/wp-content/uploads/Sitecore-Media-Library/Gatt/Xml/Services/org.bluetooth.service.health_thermometer.xml */ +const GattServiceCharacteristic direct_bt::GATT_HEALTH_THERMOMETER_SRVC = { HEALTH_THERMOMETER, + { { TEMPERATURE_MEASUREMENT, Mandatory, + // GattCharacteristicPropertySpec[9]: + { { Read, Excluded }, + { WriteWithAck, Excluded }, { WriteNoAck, Excluded }, { AuthSignedWrite, Excluded }, { ReliableWriteExt, Excluded }, + { Notify, Excluded }, { Indicate, Mandatory }, { AuxWriteExt, Excluded }, { Broadcast, Excluded } }, + // GattClientCharacteristicConfigSpec: + { Mandatory, { Read, Mandatory}, { WriteWithAck, Mandatory } } + }, + { TEMPERATURE_TYPE, Optional, + // GattCharacteristicPropertySpec[9]: + { { Read, Mandatory }, + { WriteWithAck, Excluded }, { WriteNoAck, Excluded }, { AuthSignedWrite, Excluded }, { ReliableWriteExt, Excluded }, + { Notify, Excluded }, { Indicate, Excluded }, { AuxWriteExt, Excluded }, { Broadcast, Excluded } }, + // GattClientCharacteristicConfigSpec: + { Excluded, { Read, Excluded}, { WriteWithAck, Excluded } } + }, + { INTERMEDIATE_TEMPERATURE, Optional, + // GattCharacteristicPropertySpec[9]: + { { Read, Excluded }, + { WriteWithAck, Excluded }, { WriteNoAck, Excluded }, { AuthSignedWrite, Excluded }, { ReliableWriteExt, Excluded }, + { Notify, Mandatory }, { Indicate, Excluded }, { AuxWriteExt, Excluded }, { Broadcast, Excluded } }, + // GattClientCharacteristicConfigSpec: + { if_characteristic_supported, { Read, Mandatory}, { WriteWithAck, Mandatory } } + }, + { MEASUREMENT_INTERVAL, Optional, + // GattCharacteristicPropertySpec[9]: + { { Read, Mandatory }, + { WriteWithAck, Optional }, { WriteNoAck, Excluded }, { AuthSignedWrite, Excluded }, { ReliableWriteExt, Excluded }, + { Notify, Excluded }, { Indicate, Optional }, { AuxWriteExt, Excluded }, { Broadcast, Excluded } }, + // GattClientCharacteristicConfigSpec: + { if_notify_or_indicate_supported, { Read, Mandatory}, { WriteWithAck, Mandatory } } + }, + } }; + +const GattServiceCharacteristic direct_bt::GATT_DEVICE_INFORMATION_SRVC = { DEVICE_INFORMATION, + { { MANUFACTURER_NAME_STRING, Optional, + // GattCharacteristicPropertySpec[9]: + { { Read, Mandatory }, + { WriteWithAck, Excluded }, { WriteNoAck, Excluded }, { AuthSignedWrite, Excluded }, { ReliableWriteExt, Excluded }, + { Notify, Excluded }, { Indicate, Mandatory }, { AuxWriteExt, Excluded }, { Broadcast, Excluded } }, + // GattClientCharacteristicConfigSpec: + { Excluded, { Read, Excluded}, { WriteWithAck, Excluded } } + }, + { MODEL_NUMBER_STRING, Optional, + // GattCharacteristicPropertySpec[9]: + { { Read, Mandatory }, + { WriteWithAck, Excluded }, { WriteNoAck, Excluded }, { AuthSignedWrite, Excluded }, { ReliableWriteExt, Excluded }, + { Notify, Excluded }, { Indicate, Mandatory }, { AuxWriteExt, Excluded }, { Broadcast, Excluded } }, + // GattClientCharacteristicConfigSpec: + { Excluded, { Read, Excluded}, { WriteWithAck, Excluded } } + }, + { SERIAL_NUMBER_STRING, Optional, + // GattCharacteristicPropertySpec[9]: + { { Read, Mandatory }, + { WriteWithAck, Excluded }, { WriteNoAck, Excluded }, { AuthSignedWrite, Excluded }, { ReliableWriteExt, Excluded }, + { Notify, Excluded }, { Indicate, Mandatory }, { AuxWriteExt, Excluded }, { Broadcast, Excluded } }, + // GattClientCharacteristicConfigSpec: + { Excluded, { Read, Excluded}, { WriteWithAck, Excluded } } + }, + { HARDWARE_REVISION_STRING, Optional, + // GattCharacteristicPropertySpec[9]: + { { Read, Mandatory }, + { WriteWithAck, Excluded }, { WriteNoAck, Excluded }, { AuthSignedWrite, Excluded }, { ReliableWriteExt, Excluded }, + { Notify, Excluded }, { Indicate, Mandatory }, { AuxWriteExt, Excluded }, { Broadcast, Excluded } }, + // GattClientCharacteristicConfigSpec: + { Excluded, { Read, Excluded}, { WriteWithAck, Excluded } } + }, + { FIRMWARE_REVISION_STRING, Optional, + // GattCharacteristicPropertySpec[9]: + { { Read, Mandatory }, + { WriteWithAck, Excluded }, { WriteNoAck, Excluded }, { AuthSignedWrite, Excluded }, { ReliableWriteExt, Excluded }, + { Notify, Excluded }, { Indicate, Mandatory }, { AuxWriteExt, Excluded }, { Broadcast, Excluded } }, + // GattClientCharacteristicConfigSpec: + { Excluded, { Read, Excluded}, { WriteWithAck, Excluded } } + }, + { SOFTWARE_REVISION_STRING, Optional, + // GattCharacteristicPropertySpec[9]: + { { Read, Mandatory }, + { WriteWithAck, Excluded }, { WriteNoAck, Excluded }, { AuthSignedWrite, Excluded }, { ReliableWriteExt, Excluded }, + { Notify, Excluded }, { Indicate, Mandatory }, { AuxWriteExt, Excluded }, { Broadcast, Excluded } }, + // GattClientCharacteristicConfigSpec: + { Excluded, { Read, Excluded}, { WriteWithAck, Excluded } } + }, + { SYSTEM_ID, Optional, + // GattCharacteristicPropertySpec[9]: + { { Read, Mandatory }, + { WriteWithAck, Excluded }, { WriteNoAck, Excluded }, { AuthSignedWrite, Excluded }, { ReliableWriteExt, Excluded }, + { Notify, Excluded }, { Indicate, Mandatory }, { AuxWriteExt, Excluded }, { Broadcast, Excluded } }, + // GattClientCharacteristicConfigSpec: + { Excluded, { Read, Excluded}, { WriteWithAck, Excluded } } + }, + { REGULATORY_CERT_DATA_LIST, Optional, + // GattCharacteristicPropertySpec[9]: + { { Read, Mandatory }, + { WriteWithAck, Excluded }, { WriteNoAck, Excluded }, { AuthSignedWrite, Excluded }, { ReliableWriteExt, Excluded }, + { Notify, Excluded }, { Indicate, Mandatory }, { AuxWriteExt, Excluded }, { Broadcast, Excluded } }, + // GattClientCharacteristicConfigSpec: + { Excluded, { Read, Excluded}, { WriteWithAck, Excluded } } + }, + { PNP_ID, Optional, + // GattCharacteristicPropertySpec[9]: + { { Read, Mandatory }, + { WriteWithAck, Excluded }, { WriteNoAck, Excluded }, { AuthSignedWrite, Excluded }, { ReliableWriteExt, Excluded }, + { Notify, Excluded }, { Indicate, Mandatory }, { AuxWriteExt, Excluded }, { Broadcast, Excluded } }, + // GattClientCharacteristicConfigSpec: + { Excluded, { Read, Excluded}, { WriteWithAck, Excluded } } + } + } }; + +const std::vector<const GattServiceCharacteristic*> direct_bt::GATT_SERVICES = { + &direct_bt::GATT_GENERIC_ACCESS_SRVC, &direct_bt::GATT_HEALTH_THERMOMETER_SRVC, &direct_bt::GATT_DEVICE_INFORMATION_SRVC }; + +#define CASE_TO_STRING(V) case V: return #V; + +#define SERVICE_TYPE_ENUM(X) \ + X(GENERIC_ACCESS) \ + X(HEALTH_THERMOMETER) \ + X(DEVICE_INFORMATION) \ + X(BATTERY_SERVICE) + +std::string direct_bt::GattServiceTypeToString(const GattServiceType v) { + switch(v) { + SERVICE_TYPE_ENUM(CASE_TO_STRING) + default: ; // fall through intended + } + return "Unknown"; +} + +#define CHARACTERISTIC_TYPE_ENUM(X) \ + X(DEVICE_NAME) \ + X(APPEARANCE) \ + X(PERIPHERAL_PRIVACY_FLAG) \ + X(RECONNECTION_ADDRESS) \ + X(PERIPHERAL_PREFERRED_CONNECTION_PARAMETERS) \ + X(TEMPERATURE) \ + X(TEMPERATURE_CELSIUS) \ + X(TEMPERATURE_FAHRENHEIT) \ + X(TEMPERATURE_MEASUREMENT) \ + X(TEMPERATURE_TYPE) \ + X(INTERMEDIATE_TEMPERATURE) \ + X(MEASUREMENT_INTERVAL) \ + X(SYSTEM_ID) \ + X(MODEL_NUMBER_STRING) \ + X(SERIAL_NUMBER_STRING) \ + X(FIRMWARE_REVISION_STRING) \ + X(HARDWARE_REVISION_STRING) \ + X(SOFTWARE_REVISION_STRING) \ + X(MANUFACTURER_NAME_STRING) \ + X(REGULATORY_CERT_DATA_LIST) \ + X(PNP_ID) + + +std::string direct_bt::GattCharacteristicTypeToString(const GattCharacteristicType v) { + switch(v) { + CHARACTERISTIC_TYPE_ENUM(CASE_TO_STRING) + default: ; // fall through intended + } + return "Unknown"; +} + +#define CHARACTERISTIC_PROP_ENUM(X) \ + X(Broadcast) \ + X(Read) \ + X(WriteNoAck) \ + X(WriteWithAck) \ + X(Notify) \ + X(Indicate) \ + X(AuthSignedWrite) \ + X(ExtProps) \ + X(ReliableWriteExt) \ + X(AuxWriteExt) + +std::string direct_bt::GattCharacteristicPropertyToString(const GattCharacteristicProperty v) { + switch(v) { + CHARACTERISTIC_PROP_ENUM(CASE_TO_STRING) + default: ; // fall through intended + } + return "Unknown"; +} + +#define REQUIREMENT_SPEC_ENUM(X) \ + X(Excluded) \ + X(Mandatory) \ + X(Optional) \ + X(Conditional) \ + X(if_characteristic_supported) \ + X(if_notify_or_indicate_supported) \ + X(C1) + +std::string direct_bt::GattRequirementSpecToString(const GattRequirementSpec v) { + switch(v) { + REQUIREMENT_SPEC_ENUM(CASE_TO_STRING) + default: ; // fall through intended + } + return "Unknown"; +} + +std::string GattCharacteristicPropertySpec::toString() const { + return GattCharacteristicPropertyToString(property)+": "+GattRequirementSpecToString(requirement); +} + +std::string GattClientCharacteristicConfigSpec::toString() const { + return "ClientCharCfg["+GattRequirementSpecToString(requirement)+"["+read.toString()+", "+writeWithAck.toString()+"]]"; +} + +std::string GattCharacteristicSpec::toString() const { + std::string res = GattCharacteristicTypeToString(characteristic)+": "+GattRequirementSpecToString(requirement)+", Properties["; + for(size_t i=0; i<propertySpec.size(); i++) { + if(0<i) { + res += ", "; + } + res += propertySpec.at(i).toString(); + } + res += "], "+clientConfig.toString(); + return res; +} + +std::string GattServiceCharacteristic::toString() const { + std::string res = GattServiceTypeToString(service)+": ["; + for(size_t i=0; i<characteristics.size(); i++) { + if(0<i) { + res += ", "; + } + res += "["+characteristics.at(i).toString()+"]"; + } + res += "]"; + return res; +} + +const GattServiceCharacteristic * direct_bt::findGattServiceChar(const uint16_t uuid16) { + for(size_t i=0; i<GATT_SERVICES.size(); i++) { + const GattServiceCharacteristic & serviceChar = *GATT_SERVICES.at(i); + if( uuid16 == serviceChar.service ) { + return &serviceChar; + } + for(size_t j=0; j<serviceChar.characteristics.size(); j++) { + const GattCharacteristicSpec & charSpec = serviceChar.characteristics.at(i); + if( uuid16 == charSpec.characteristic ) { + return &serviceChar; + } + } + } + return nullptr; +} + +const GattCharacteristicSpec * direct_bt::findGattCharSpec(const uint16_t uuid16) { + for(size_t i=0; i<GATT_SERVICES.size(); i++) { + const GattServiceCharacteristic & serviceChar = *GATT_SERVICES.at(i); + for(size_t j=0; j<serviceChar.characteristics.size(); j++) { + const GattCharacteristicSpec & charSpec = serviceChar.characteristics.at(i); + if( uuid16 == charSpec.characteristic ) { + return &charSpec; + } + } + } + return nullptr; +} + +/********************************************************/ +/********************************************************/ +/********************************************************/ + +std::string direct_bt::GattNameToString(const TROOctets &v) { + const int str_len = v.getSize(); + POctets s(str_len+1); // dtor releases chunk + memcpy(s.get_wptr(), v.get_ptr(), str_len); + s.put_uint8(str_len, 0); // EOS + return std::string((const char*)s.get_ptr()); +} + +PeriphalPreferredConnectionParameters::PeriphalPreferredConnectionParameters(const TROOctets &source) +: minConnectionInterval(source.get_uint16(0)), maxConnectionInterval(source.get_uint16(2)), + slaveLatency(source.get_uint16(4)), connectionSupervisionTimeoutMultiplier(source.get_uint16(6)) +{ +} + +std::string PeriphalPreferredConnectionParameters::toString() const { + return "PrefConnectionParam[interval["+ + std::to_string(minConnectionInterval)+".."+std::to_string(maxConnectionInterval)+ + "], slaveLatency "+std::to_string(slaveLatency)+ + ", csTimeoutMul "+std::to_string(connectionSupervisionTimeoutMultiplier)+"]"; +} + +#define GENERIC_ACCESS_APPEARANCECAT_ENUM(X) \ + X(UNKNOWN) \ + X(GENERIC_PHONE) \ + X(GENERIC_COMPUTER) \ + X(GENERIC_WATCH) \ + X(SPORTS_WATCH) \ + X(GENERIC_CLOCK) \ + X(GENERIC_DISPLAY) \ + X(GENERIC_REMOTE_CLOCK) \ + X(GENERIC_EYE_GLASSES) \ + X(GENERIC_TAG) \ + X(GENERIC_KEYRING) \ + X(GENERIC_MEDIA_PLAYER) \ + X(GENERIC_BARCODE_SCANNER) \ + X(GENERIC_THERMOMETER) \ + X(GENERIC_THERMOMETER_EAR) \ + X(GENERIC_HEART_RATE_SENSOR) \ + X(HEART_RATE_SENSOR_BELT) \ + X(GENERIC_BLOD_PRESSURE) \ + X(BLOD_PRESSURE_ARM) \ + X(BLOD_PRESSURE_WRIST) \ + X(HID) \ + X(HID_KEYBOARD) \ + X(HID_MOUSE) \ + X(HID_JOYSTICK) \ + X(HID_GAMEPAD) \ + X(HID_DIGITIZER_TABLET) \ + X(HID_CARD_READER) \ + X(HID_DIGITAL_PEN) \ + X(HID_BARCODE_SCANNER) \ + X(GENERIC_GLUCOSE_METER) \ + X(GENERIC_RUNNING_WALKING_SENSOR) \ + X(RUNNING_WALKING_SENSOR_IN_SHOE) \ + X(RUNNING_WALKING_SENSOR_ON_SHOE) \ + X(RUNNING_WALKING_SENSOR_HIP) \ + X(GENERIC_CYCLING) \ + X(CYCLING_COMPUTER) \ + X(CYCLING_SPEED_SENSOR) \ + X(CYCLING_CADENCE_SENSOR) \ + X(CYCLING_POWER_SENSOR) \ + X(CYCLING_SPEED_AND_CADENCE_SENSOR) \ + X(GENERIC_PULSE_OXIMETER) \ + X(PULSE_OXIMETER_FINGERTIP) \ + X(PULSE_OXIMETER_WRIST) \ + X(GENERIC_WEIGHT_SCALE) \ + X(GENERIC_PERSONAL_MOBILITY_DEVICE) \ + X(PERSONAL_MOBILITY_DEVICE_WHEELCHAIR) \ + X(PERSONAL_MOBILITY_DEVICE_SCOOTER) \ + X(GENERIC_CONTINUOUS_GLUCOSE_MONITOR) \ + X(GENERIC_INSULIN_PUMP) \ + X(INSULIN_PUMP_DURABLE) \ + X(INSULIN_PUMP_PATCH) \ + X(INSULIN_PUMP_PEN) \ + X(GENERIC_MEDICATION_DELIVERY) \ + X(GENERIC_OUTDOOR_SPORTS_ACTIVITY) \ + X(OUTDOOR_SPORTS_ACTIVITY_LOCATION_DISPLAY_DEVICE) \ + X(OUTDOOR_SPORTS_ACTIVITY_LOCATION_AND_NAVIGATION_DISPLAY_DEVICE) \ + X(OUTDOOR_SPORTS_ACTIVITY_LOCATION_POD) \ + X(OUTDOOR_SPORTS_ACTIVITY_LOCATION_AND_NAVIGATION_POD) \ + +std::string GenericAccess::AppearanceCatToString(const AppearanceCat v) { + switch(v) { + GENERIC_ACCESS_APPEARANCECAT_ENUM(CASE_TO_STRING) + default: ; // fall through intended + } + return "Unknown"; +} + +std::string GenericAccess::toString() const { + return "'"+deviceName+"'[cat "+AppearanceCatToString(category)+", "+prefConnParam.toString()+"]"; +} + +PnP_ID::PnP_ID(const TROOctets &source) +: vendor_id_source(source.get_uint8(0)), vendor_id(source.get_uint16(1)), + product_id(source.get_uint16(3)), product_version(source.get_uint16(5)) {} + +std::string PnP_ID::toString() const { + return "vendor_id[source "+uint8HexString(vendor_id_source, true)+ + ", id "+uint16HexString(vendor_id, true)+ + "], product_id "+uint16HexString(product_id, true)+ + ", product_version "+uint16HexString(product_version, true); +} + +std::string DeviceInformation::toString() const { + return "DeviceInfo[manufacturer '"+manufacturer+"', model '"+modelNumber+"', serial '"+serialNumber+"', systemID '"+systemID.toString()+ + "', revisions[firmware '"+firmwareRevision+"', hardware '"+hardwareRevision+"', software '"+softwareRevision+ + "'], pnpID["+pnpID.toString()+"], regCertData '"+regulatoryCertDataList.toString()+"']"; +} + +std::shared_ptr<TemperatureMeasurementCharateristic> TemperatureMeasurementCharateristic::get(const TROOctets &source) { + const int size = source.getSize(); + int reqSize = 1 + 4; // max size = 13 + if( reqSize > size ) { + // min size: flags + temperatureValue + return nullptr; + } + + uint8_t flags = source.get_uint8(0); + bool hasTimestamp = 0 != ( flags & Bits::HAS_TIMESTAMP ); + if( hasTimestamp ) { + reqSize += 7; + } + bool hasTemperatureType = 0 != ( flags & Bits::HAS_TEMP_TYPE ); + if( hasTemperatureType ) { + reqSize += 1; + } + if( reqSize > size ) { + return nullptr; + } + + uint32_t raw_temp_value = source.get_uint32(1); + float temperatureValue = ieee11073::FloatTypes::float32_IEEE11073_to_IEEE754(raw_temp_value); + + /** Timestamp, if HAS_TIMESTAMP is set. */ + ieee11073::AbsoluteTime timestamp; + if( hasTemperatureType ) { + timestamp = ieee11073::AbsoluteTime(source.get_ptr(1+4), 7); + } + + /** Temperature Type, if HAS_TEMP_TYPE is set: Format ???? */ + uint8_t temperature_type=0; + if( hasTemperatureType ) { + temperature_type = source.get_uint8(1+4+7); + } + return std::shared_ptr<TemperatureMeasurementCharateristic>(new TemperatureMeasurementCharateristic(flags, temperatureValue, timestamp, temperature_type)); +} + +std::string TemperatureMeasurementCharateristic::toString() const { + std::string res = std::to_string(temperatureValue); + res += isFahrenheit() ? " F" : " C"; + if( hasTimestamp() ) { + res += ", "+timestamp.toString(); + } + if( hasTemperatureType() ) { + res += ", type "+std::to_string(temperature_type); + } + return res; +} |