diff --git a/android/gatt.c b/android/gatt.c
index 54cb8a6..66960fb 100644
--- a/android/gatt.c
+++ b/android/gatt.c
APP_SERVER,
} gatt_app_type_t;
+struct pending_trans_data {
+ unsigned int id;
+ uint8_t opcode;
+};
+
struct gatt_app {
int32_t id;
uint8_t uuid[16];
/* Valid for client applications */
struct queue *notifications;
+
+ /* Transaction data valid for server application */
+ struct pending_trans_data trans_id;
};
struct element_id {
HAL_OP_GATT_SERVER_ADD_INC_SERVICE, status);
}
+static void send_gatt_response(uint8_t opcode, uint16_t handle,
+ uint16_t offset, uint8_t status,
+ uint16_t len, const uint8_t *data,
+ bdaddr_t *bdaddr)
+{
+ struct gatt_device *dev;
+ uint16_t length;
+ uint8_t pdu[ATT_DEFAULT_LE_MTU];
+
+ dev = find_device_by_addr(bdaddr);
+ if (!dev) {
+ error("gatt: send_gatt_response, could not find dev");
+ return;
+ }
+
+ if (!status) {
+ length = enc_error_resp(opcode, handle, status, pdu,
+ sizeof(pdu));
+ g_attrib_send(dev->attrib, 0, pdu, length, NULL, NULL, NULL);
+ }
+ /* TODO: Send responses for other commands */
+}
+
+static void set_trans_id(struct gatt_app *app, unsigned int id, int8_t opcode)
+{
+ app->trans_id.id = id;
+ app->trans_id.opcode = opcode;
+}
+
+static void write_cb(uint16_t handle, uint16_t offset,
+ const uint8_t *value, size_t len,
+ uint8_t att_opcode, bdaddr_t *bdaddr,
+ void *user_data)
+{
+ struct hal_ev_gatt_server_request_write ev;
+ struct gatt_app *app;
+ int32_t id = PTR_TO_INT(user_data);
+ static int32_t trans_id = 1;
+ struct app_connection *conn;
+
+ app = find_app_by_id(id);
+ if (!app) {
+ error("gatt: write_cb could not found app id");
+ goto failed;
+ }
+
+ conn = find_conn(bdaddr, app->id);
+ if (!conn) {
+ error("gatt: write_cb could not found connection");
+ goto failed;
+ }
+
+ /* Store the request data, complete callback and transaction id */
+ set_trans_id(app, trans_id++, att_opcode);
+
+ /* TODO figure it out */
+ if (att_opcode == ATT_OP_EXEC_WRITE_REQ)
+ goto failed;
+
+ memset(&ev, 0, sizeof(ev));
+
+ bdaddr2android(bdaddr, ev.bdaddr);
+ ev.attr_handle = handle;
+ ev.offset = offset;
+
+ ev.conn_id = conn->id;
+ ev.trans_id = app->trans_id.id;
+
+ ev.is_prep = att_opcode == ATT_OP_PREP_WRITE_REQ;
+ ev.need_rsp = att_opcode == ATT_OP_WRITE_REQ;
+
+ ev.length = len;
+ memcpy(&ev.value, value, len);
+
+ return;
+
+failed:
+ send_gatt_response(att_opcode, handle, 0, ATT_ECODE_UNLIKELY, 0, NULL,
+ bdaddr);
+}
+
static void handle_server_add_characteristic(const void *buf, uint16_t len)
{
const struct hal_cmd_gatt_server_add_characteristic *cmd = buf;
struct gatt_app *server;
bt_uuid_t uuid;
uint8_t status;
+ int32_t app_id = cmd->server_if;
DBG("");
memset(&ev, 0, sizeof(ev));
- server = find_app_by_id(cmd->server_if);
+ server = find_app_by_id(app_id);
if (!server) {
status = HAL_STATUS_FAILED;
goto failed;
android2uuid(cmd->uuid, &uuid);
+ /*FIXME: Handle properties. Register callback if needed. */
ev.char_handle = gatt_db_add_characteristic(gatt_db,
cmd->service_handle,
&uuid, cmd->permissions,
cmd->properties,
- NULL, NULL, NULL);
+ NULL, write_cb,
+ INT_TO_PTR(app_id));
if (!ev.char_handle)
status = HAL_STATUS_FAILED;
else
failed:
ev.srvc_handle = cmd->service_handle;
ev.status = status;
- ev.server_if = cmd->server_if;
+ ev.server_if = app_id;
ev.status = status == HAL_STATUS_SUCCESS ? GATT_SUCCESS : GATT_FAILURE;
memcpy(ev.uuid, cmd->uuid, sizeof(cmd->uuid));
struct gatt_app *server;
bt_uuid_t uuid;
uint8_t status;
+ int32_t app_id = cmd->server_if;
DBG("");
memset(&ev, 0, sizeof(ev));
- server = find_app_by_id(cmd->server_if);
+ server = find_app_by_id(app_id);
if (!server) {
status = HAL_STATUS_FAILED;
goto failed;
android2uuid(cmd->uuid, &uuid);
+ /*FIXME: Handle properties. Register callback if needed. */
ev.descr_handle = gatt_db_add_char_descriptor(gatt_db,
cmd->service_handle,
&uuid, cmd->permissions,
- NULL, NULL, NULL);
+ NULL, write_cb,
+ INT_TO_PTR(app_id));
if (!ev.descr_handle)
status = HAL_STATUS_FAILED;
else
status = HAL_STATUS_SUCCESS;
failed:
- ev.server_if = cmd->server_if;
+ ev.server_if = app_id;
ev.srvc_handle = cmd->service_handle;
memcpy(ev.uuid, cmd->uuid, sizeof(cmd->uuid));
ev.status = status == HAL_STATUS_SUCCESS ? GATT_SUCCESS : GATT_FAILURE;