Re: [PATCH 08/10] battery: Read Battery level characteristic

[Date Prev][Date Next][Thread Prev][Thread Next][Date Index][Thread Index]

 



On 09/12/2012 12:50 AM, Joao Paulo Rechi Vita wrote:
On Tue, Sep 11, 2012 at 4:38 AM,  <chen.ganir@xxxxxx> wrote:
From: Chen Ganir <chen.ganir@xxxxxx>

Implement support for reading the battery level characteristic on
connection establishment.
---
  profiles/battery/battery.c |   87 +++++++++++++++++++++++++++++++++++++++++++-
  1 file changed, 85 insertions(+), 2 deletions(-)

diff --git a/profiles/battery/battery.c b/profiles/battery/battery.c
index 31f2297..a93b352 100644
--- a/profiles/battery/battery.c
+++ b/profiles/battery/battery.c
@@ -55,6 +55,7 @@ struct characteristic {
         GSList                          *desc;  /* Descriptors */
         uint8_t                 ns;             /* Battery Namespace */
         uint16_t                description;    /* Battery description */
+       uint8_t        level;

Alignment problem here.

Thanks.


  };

  struct descriptor {
@@ -103,6 +104,80 @@ static void battery_free(gpointer user_data)
         g_free(batt);
  }

+static void read_batterylevel_cb(guint8 status, const guint8 *pdu, guint16 len,
+                                                       gpointer user_data)
+{
+       struct characteristic *ch = user_data;
+       uint8_t value[ATT_MAX_MTU];
+       int vlen;
+
+       if (status != 0) {
+               error("Failed to read Battery Level:%s", att_ecode2str(status));
+               return;
+       }
+
+       vlen = dec_read_resp(pdu, len, value, sizeof(value));
+       if (!vlen) {
+               error("Failed to read Battery Level: Protocol error\n");
+               return;
+       }
+
+       if (vlen < 1) {
+               error("Failed to read Battery Level: Wrong pdu len");
+               return;
+       }
+
+       ch->level = value[0];
+       btd_device_set_battery_opt(ch->devbatt, BATTERY_OPT_LEVEL, ch->level,
+                                               BATTERY_OPT_INVALID);
+}
+
+static void process_batteryservice_char(struct characteristic *ch)
+{
+       if (g_strcmp0(ch->attr.uuid, BATTERY_LEVEL_UUID) == 0) {
+               gatt_read_char(ch->batt->attrib, ch->attr.value_handle, 0,
+                                               read_batterylevel_cb, ch);
+       }
+}
+
+static gint device_battery_cmp(gconstpointer a, gconstpointer b)
+{
+       const struct characteristic *ch = a;
+       const struct device_battery *batt = b;
+
+       if (batt == ch->devbatt)
+               return 0;
+
+       return -1;
+}
+
+static struct characteristic *find_battery_char(struct device_battery *db)
+{
+       GSList *l, *b;
+
+       for (l = servers; l != NULL; l = g_slist_next(l)) {
+               struct battery *batt = l->data;
+
+               b = g_slist_find_custom(batt->chars, db, device_battery_cmp);
+               if (!b)
+                       return NULL;
+
+               return b->data;
+       }
+
+       return NULL;
+}
+
+static void batterylevel_refresh_cb(struct device_battery *batt)
+{
+       struct characteristic *ch;
+
+       ch = find_battery_char(batt);
+
+       if (ch)
+               process_batteryservice_char(ch);
+}
+
  static void batterylevel_presentation_format_desc_cb(guint8 status,
                                                 const guint8 *pdu, guint16 len,
                                                 gpointer user_data)
@@ -151,7 +226,6 @@ static void process_batterylevel_desc(struct descriptor *desc)
         DBG("Ignored descriptor %s characteristic %s", uuidstr, ch->attr.uuid);
  }

-
  static void discover_desc_cb(guint8 status, const guint8 *pdu, guint16 len,
                                                         gpointer user_data)
  {
@@ -192,8 +266,11 @@ static void discover_desc_cb(guint8 status, const guint8 *pdu, guint16 len,

  update_char:
         ch->devbatt = btd_device_add_battery(ch->batt->dev);
-}
+       btd_device_set_battery_opt(ch->devbatt, BATTERY_OPT_REFRESH_FUNC,
+                             batterylevel_refresh_cb, BATTERY_OPT_INVALID);

+       process_batteryservice_char(ch);

There two call also should be part of configure_battery_cb() instead
of discover_desc_cb().

True. Once i move the btd_device_add_battery call, i'll move those as well.

+}

  static void configure_battery_cb(GSList *characteristics, guint8 status,

@@ -252,6 +329,12 @@ static void attio_connected_cb(GAttrib *attrib, gpointer user_data)
                 gatt_discover_char(batt->attrib, batt->svc_range->start,
                                         batt->svc_range->end, NULL,
                                         configure_battery_cb, batt);
+       } else {
+               GSList *l;
+               for (l = batt->chars; l; l = l->next) {
+                       struct characteristic *c = l->data;
+                       process_batteryservice_char(c);
+               }
         }
  }

--
1.7.9.5

--
To unsubscribe from this list: send the line "unsubscribe linux-bluetooth" in
the body of a message to majordomo@xxxxxxxxxxxxxxx
More majordomo info at  http://vger.kernel.org/majordomo-info.html




Thanks,


--
BR,
Chen Ganir

--
To unsubscribe from this list: send the line "unsubscribe linux-bluetooth" in
the body of a message to majordomo@xxxxxxxxxxxxxxx
More majordomo info at  http://vger.kernel.org/majordomo-info.html


[Index of Archives]     [Bluez Devel]     [Linux Wireless Networking]     [Linux Wireless Personal Area Networking]     [Linux ATH6KL]     [Linux USB Devel]     [Linux Media Drivers]     [Linux Audio Users]     [Linux Kernel]     [Linux SCSI]     [Big List of Linux Books]

  Powered by Linux