Return-Path: From: Santiago Carot-Nemesio To: linux-bluetooth@vger.kernel.org Cc: Santiago Carot-Nemesio Subject: [PATCH 08/19] Read measurement interval characteristic Date: Tue, 20 Sep 2011 19:47:20 +0200 Message-Id: <1316540841-14713-9-git-send-email-sancane@gmail.com> In-Reply-To: <1316540841-14713-8-git-send-email-sancane@gmail.com> References: <1316540841-14713-1-git-send-email-sancane@gmail.com> <1316540841-14713-2-git-send-email-sancane@gmail.com> <1316540841-14713-3-git-send-email-sancane@gmail.com> <1316540841-14713-4-git-send-email-sancane@gmail.com> <1316540841-14713-5-git-send-email-sancane@gmail.com> <1316540841-14713-6-git-send-email-sancane@gmail.com> <1316540841-14713-7-git-send-email-sancane@gmail.com> <1316540841-14713-8-git-send-email-sancane@gmail.com> Sender: linux-bluetooth-owner@vger.kernel.org List-ID: --- thermometer/thermometer.c | 81 ++++++++++++++++++++++++++++++++++++++++++++- 1 files changed, 80 insertions(+), 1 deletions(-) diff --git a/thermometer/thermometer.c b/thermometer/thermometer.c index 2dcc4ba..0178e99 100644 --- a/thermometer/thermometer.c +++ b/thermometer/thermometer.c @@ -23,6 +23,7 @@ #include #include +#include "dbus-common.h" #include "adapter.h" #include "device.h" #include "error.h" @@ -136,6 +137,60 @@ static gint cmp_device(gconstpointer a, gconstpointer b) return -1; } +static void change_property(struct thermometer *t, const gchar *name, + gpointer value) { + if (g_strcmp0(name, "Intermediate") == 0) { + gboolean *intermediate = value; + if (t->properties.intermediate == *intermediate) + return; + + t->properties.intermediate = *intermediate; + emit_property_changed(t->conn, device_get_path(t->dev), + THERMOMETER_INTERFACE, name, + DBUS_TYPE_BOOLEAN, + &t->properties.intermediate); + } else if (g_strcmp0(name, "Interval") == 0) { + uint16_t *interval = value; + if (t->properties.interval && + *t->properties.interval == *interval) + return; + + if (!t->properties.interval) + t->properties.interval = g_new0(guint16, 1); + + *t->properties.interval = *interval; + emit_property_changed(t->conn, device_get_path(t->dev), + THERMOMETER_INTERFACE, name, + DBUS_TYPE_UINT16, + t->properties.interval); + } else if (g_strcmp0(name, "Maximum") == 0) { + uint16_t *max = value; + if (t->properties.max && *t->properties.max == *max) + return; + + if (!t->properties.max) + t->properties.max = g_new0(guint16, 1); + + *t->properties.max = *max; + emit_property_changed(t->conn, device_get_path(t->dev), + THERMOMETER_INTERFACE, name, + DBUS_TYPE_UINT16, t->properties.max); + } else if (g_strcmp0(name, "Minimum") == 0) { + uint16_t *min = value; + if (t->properties.min && *t->properties.min == *min) + return; + + if (!t->properties.min) + t->properties.min = g_new0(guint16, 1); + + *t->properties.min = *min; + emit_property_changed(t->conn, device_get_path(t->dev), + THERMOMETER_INTERFACE, name, + DBUS_TYPE_UINT16, t->properties.min); + } else + DBG("%s is not a thermometer property", name); +} + static void discover_desc_cb(guint8 status, const guint8 *pdu, guint16 len, gpointer user_data) { @@ -171,7 +226,31 @@ static void read_temp_type_cb(guint8 status, const guint8 *pdu, guint16 len, static void read_interval_cb(guint8 status, const guint8 *pdu, guint16 len, gpointer user_data) { - /* TODO */ + struct characteristic *ch = user_data; + uint8_t value[ATT_MAX_MTU]; + uint16_t *p, interval; + int vlen; + + if (status != 0) { + DBG("Measurement Interval value read failed: %s", + att_ecode2str(status)); + return; + } + + if (!dec_read_resp(pdu, len, value, &vlen)) { + DBG("Protocol error\n"); + return; + } + + if (vlen < 2) { + DBG("Invalid Interval received"); + return; + } + + p = (uint16_t *) value; + interval = btohs(*p); + + change_property(ch->t, "Interval", &interval); } static void process_thermometer_char(struct characteristic *ch) -- 1.7.6.1