core: Add GoepL2capPsm lookup for external OBEX profiles

1 files changed, 21 insertions, 0 deletions

diff --git a/src/profile.c b/src/profile.c
index 11bc05866..338e9036e 100644
--- a/src/profile.c
+++ b/src/profile.c
@@ -698,6 +698,24 @@ static int connect_io(struct ext_io *conn, bdaddr_t *src, bdaddr_t *dst)
 	return 0;
 }
 
+static uint16_t get_goep_l2cap_psm(sdp_record_t *rec)
+{
+	sdp_data_t *data;
+
+	data = sdp_data_get(rec, SDP_ATTR_GOEP_L2CAP_PSM);
+	if (!data)
+		return 0;
+
+	if (data->dtd != SDP_UINT16)
+		return 0;
+
+	/* PSM must be odd and lsb of upper byte must be 0 */
+	if ((data->val.uint16 & 0x0101) != 0x0001)
+		return 0;
+
+	return data->val.uint16;
+}
+
 static void record_cb(sdp_list_t *recs, int err, gpointer user_data)
 {
 	struct ext_io *conn = user_data;
@@ -737,6 +755,9 @@ static void record_cb(sdp_list_t *recs, int err, gpointer user_data)
 		if (port > 0)
 			ext->chan = port;
 
+		if (ext->psm == 0 && sdp_get_proto_desc(protos, OBEX_UUID))
+			ext->psm = get_goep_l2cap_psm(rec);
+
 		sdp_list_foreach(protos, (sdp_list_func_t) sdp_list_free,
 									NULL);
 		sdp_list_free(protos, NULL);