Received: by 2002:ab2:6309:0:b0:1fb:d597:ff75 with SMTP id s9csp575760lqt; Thu, 6 Jun 2024 11:37:41 -0700 (PDT) X-Forwarded-Encrypted: i=3; AJvYcCX6QE5jDIyuxNkulnwZRtSexX4wXwlxoZUKIoPteX9/FFSWPzIeZJIHhGvfQbhinddXivcKEYSJsDLqU7HxlFqcIJ8vwUirxHiQcGNXrA== X-Google-Smtp-Source: AGHT+IGheGwI/U40h2PTTeZqLDrSHIx1T211aOLAFLYVYFd4c74EyD+O8sZz9IDXbJWPAF1ZvpRR X-Received: by 2002:a05:6a00:114c:b0:6ec:fdcc:40b9 with SMTP id d2e1a72fcca58-7040c65b4bbmr294707b3a.9.1717699061070; Thu, 06 Jun 2024 11:37:41 -0700 (PDT) ARC-Seal: i=2; a=rsa-sha256; t=1717699061; cv=pass; d=google.com; s=arc-20160816; b=whu0UpQimhUQgXmGJUGFipxsYFj+3rrUQBAez08R24wuQj+0I4r0YxjbE6a75fk0cf xMEJwv/JztOC2whR7IOprijRMg7WDgglIZwHURz8ZOqfxfiyU2x/Noan6y5W08C+ONTM XGLKvyqr0m15qvCn5VW87zszHbywWqcm2vwyhT83grs3IKcqPU2jGTQ9LflveqDsdsJ2 z5bb1yKKwBbKdGeHKUEimJ9i95VznB0d2lXCwns/z/oQijO1EjPiaBRS8Myxt772Iy1v Wz8PXIvnvuvKDLnDMglPs9UtqaSMW6YbKal6rgHPpZ2SfZk9B2v2zRSGcobBedgZTFXt 3OuA== ARC-Message-Signature: i=2; a=rsa-sha256; c=relaxed/relaxed; d=google.com; s=arc-20160816; h=content-transfer-encoding:mime-version:list-unsubscribe :list-subscribe:list-id:precedence:references:in-reply-to:message-id :date:subject:to:from:dkim-signature; bh=tmLRwCw5fvmkHYewvTmSzsnpuIGD6xKMMA1I4DUGgaI=; fh=Zo1xq+RG6ym2K/dIBq0nXJTuuL/kjA4/yyWp5R6oGs8=; b=jTtI/PgLpqNEfvcHq6o7cV7sifO3ctacJjPzA5vE6xcOV63uySRf0wNWox86ivML6B ua8M0/jT4k5kkjWS7gh5aqhM6SuEG1MCCO/Hb1VigH8K1RCXahWxBi/CEGshSGELZ2xE d9sLJRFY6GU5/bZZ/c9ePVmurBATe76lV23x+ZCO5PjZrAdfRgEGpzWcADObIwEIKz6b ZncctHyPedCgNoWfUoHvl4kq2muENbOSeSts6sOywtY3mH2v1KiQOlgoeVEsjdhalMZ3 r2T4ZFjYRk3OGWOhj5qg8WlDkTqWGa1TL4shYxQgjCsh+eFsf/wRK9+ttKJvhGvhCVSF IVLw==; dara=google.com ARC-Authentication-Results: i=2; mx.google.com; dkim=fail header.i=@kemnade.info header.s=20220719 header.b=UJNjULdf; arc=pass (i=1 spf=pass spfdomain=kemnade.info dkim=pass dkdomain=kemnade.info); spf=pass (google.com: domain of linux-bluetooth+bounces-5178-linux.lists.archive=gmail.com@vger.kernel.org designates 139.178.88.99 as permitted sender) smtp.mailfrom="linux-bluetooth+bounces-5178-linux.lists.archive=gmail.com@vger.kernel.org" Return-Path: Received: from sv.mirrors.kernel.org (sv.mirrors.kernel.org. [139.178.88.99]) by mx.google.com with ESMTPS id d2e1a72fcca58-703fd50c17dsi1051015b3a.262.2024.06.06.11.37.40 for (version=TLS1_3 cipher=TLS_AES_256_GCM_SHA384 bits=256/256); Thu, 06 Jun 2024 11:37:41 -0700 (PDT) Received-SPF: pass (google.com: domain of linux-bluetooth+bounces-5178-linux.lists.archive=gmail.com@vger.kernel.org designates 139.178.88.99 as permitted sender) client-ip=139.178.88.99; Authentication-Results: mx.google.com; dkim=fail header.i=@kemnade.info header.s=20220719 header.b=UJNjULdf; arc=pass (i=1 spf=pass spfdomain=kemnade.info dkim=pass dkdomain=kemnade.info); spf=pass (google.com: domain of linux-bluetooth+bounces-5178-linux.lists.archive=gmail.com@vger.kernel.org designates 139.178.88.99 as permitted sender) smtp.mailfrom="linux-bluetooth+bounces-5178-linux.lists.archive=gmail.com@vger.kernel.org" Received: from smtp.subspace.kernel.org (wormhole.subspace.kernel.org [52.25.139.140]) (using TLSv1.2 with cipher ECDHE-RSA-AES256-GCM-SHA384 (256/256 bits)) (No client certificate requested) by sv.mirrors.kernel.org (Postfix) with ESMTPS id A2B4728ED70 for ; Thu, 6 Jun 2024 18:31:02 +0000 (UTC) Received: from localhost.localdomain (localhost.localdomain [127.0.0.1]) by smtp.subspace.kernel.org (Postfix) with ESMTP id 8CAE747A62; Thu, 6 Jun 2024 18:30:48 +0000 (UTC) Authentication-Results: smtp.subspace.kernel.org; dkim=fail reason="signature verification failed" (2048-bit key) header.d=kemnade.info header.i=@kemnade.info header.b="UJNjULdf" X-Original-To: linux-bluetooth@vger.kernel.org Received: from mail2.andi.de1.cc (vmd64148.contaboserver.net [161.97.139.27]) (using TLSv1.2 with cipher ECDHE-RSA-AES256-GCM-SHA384 (256/256 bits)) (No client certificate requested) by smtp.subspace.kernel.org (Postfix) with ESMTPS id 567EB2E646; Thu, 6 Jun 2024 18:30:46 +0000 (UTC) Authentication-Results: smtp.subspace.kernel.org; arc=none smtp.client-ip=161.97.139.27 ARC-Seal:i=1; a=rsa-sha256; d=subspace.kernel.org; s=arc-20240116; t=1717698648; cv=none; b=QoCAVMeAGDFeurpVUdFoMNK2q23L1dDblQtHhOHRD08duf4JOtard+OgAAkSDH8iDEisIqSAFg7WwVDN8HScEitVvCifWZ0ZgnwzFwsw7DrOVB3R7LBDJvraHZDdOrRjqQnIQblHe+y65fP53E/s6JKaCuWab+fHS1ZI2bySCk8= ARC-Message-Signature:i=1; a=rsa-sha256; d=subspace.kernel.org; s=arc-20240116; t=1717698648; c=relaxed/simple; bh=YCFJH9i8CYXUpt91sYS6Dq7QkAvQFkMqR1g//KHWhBk=; h=From:To:Subject:Date:Message-Id:In-Reply-To:References: MIME-Version; b=iFeI0T8wWbxxICfRMccJWLJsqzfwDAoJVmAJ2Wr7dr/9WkaIbQtDQoeTsDamq1hDFmonJuklyVJq6ECj8j2jdoxDR+BP4aroELlJOySRTV7F+L8EylltrpLTkiK8UQ75wlNkPDhkdiadlmJZBAIcH+HbpqV+K4Cpwuh14RUnzHY= ARC-Authentication-Results:i=1; smtp.subspace.kernel.org; dmarc=none (p=none dis=none) header.from=kemnade.info; spf=pass smtp.mailfrom=kemnade.info; dkim=pass (2048-bit key) header.d=kemnade.info header.i=@kemnade.info header.b=UJNjULdf; arc=none smtp.client-ip=161.97.139.27 Authentication-Results: smtp.subspace.kernel.org; dmarc=none (p=none dis=none) header.from=kemnade.info Authentication-Results: smtp.subspace.kernel.org; spf=pass smtp.mailfrom=kemnade.info Received: from mail.andi.de1.cc ([2a02:c205:3004:2154::1]) by mail2.andi.de1.cc with esmtps (TLS1.3) tls TLS_ECDHE_RSA_WITH_AES_256_GCM_SHA384 (Exim 4.96) (envelope-from ) id 1sFHso-0090wp-35; Thu, 06 Jun 2024 20:30:44 +0200 DKIM-Signature: v=1; a=rsa-sha256; q=dns/txt; c=relaxed/relaxed; d=kemnade.info; s=20220719; h=Content-Transfer-Encoding:MIME-Version: References:In-Reply-To:Message-Id:Date:Subject:To:From:Sender:Reply-To:Cc: Content-Type:Content-ID:Content-Description:Resent-Date:Resent-From: Resent-Sender:Resent-To:Resent-Cc:Resent-Message-ID:List-Id:List-Help: List-Unsubscribe:List-Subscribe:List-Post:List-Owner:List-Archive; bh=tmLRwCw5fvmkHYewvTmSzsnpuIGD6xKMMA1I4DUGgaI=; b=UJNjULdfCox9UrWL3CwrZKkXSU nEm8IoSKCD8t3oqc4xVXoKmRZcMigAjYE9A0cb1J/JI85kbVsu5AeiEEBWuBEu2yq/rS7gBFekq67 zcIBjZfZ8KPLvz6KPhk7Qj80yh2N2nPSotOdz+CIwy9WAiDdvwzac+jelv+QrZ7i8g08gyUxyAshE 4XaFCovOz9TX+Yfm7haOydNKdk/xB4wVLmhT1PCFa/UKTYYoXN+TUXLggyEVP8r/8hqh791GH5S/I qYd7akUh6N1ErIa+y5LsJRcrKjq/WjpKQOaOzccWXT1oVZXWz1Ho3wWwP14cwRYL1tfUKhqyqiZyN kMSysMHQ==; Received: from p200300c20737c2001a3da2fffebfd33a.dip0.t-ipconnect.de ([2003:c2:737:c200:1a3d:a2ff:febf:d33a] helo=aktux) by mail.andi.de1.cc with esmtpsa (TLS1.3) tls TLS_ECDHE_RSA_WITH_AES_256_GCM_SHA384 (Exim 4.96) (envelope-from ) id 1sFHsk-002nvX-2Q; Thu, 06 Jun 2024 20:30:40 +0200 Received: from andi by aktux with local (Exim 4.96) (envelope-from ) id 1sFHsl-002s4W-2O; Thu, 06 Jun 2024 20:30:39 +0200 From: Andreas Kemnade To: marcel@holtmann.org, luiz.dentz@gmail.com, johan@kernel.org, pmenzel@molgen.mpg.de, jirislaby@kernel.org, andreas@kemnade.info, gregkh@linuxfoundation.org, linux-kernel@vger.kernel.org, linux-bluetooth@vger.kernel.org, Adam Ford , Tony Lindgren , tomi.valkeinen@ideasonboard.com, =?UTF-8?q?P=C3=A9ter=20Ujfalusi?= , robh@kernel.org, hns@goldelico.com Subject: [PATCH v4 2/4] Bluetooth: ti-st: Add GNSS subdevice for TI Wilink chips Date: Thu, 6 Jun 2024 20:30:30 +0200 Message-Id: <20240606183032.684481-3-andreas@kemnade.info> X-Mailer: git-send-email 2.39.2 In-Reply-To: <20240606183032.684481-1-andreas@kemnade.info> References: <20240606183032.684481-1-andreas@kemnade.info> Precedence: bulk X-Mailing-List: linux-bluetooth@vger.kernel.org List-Id: List-Subscribe: List-Unsubscribe: MIME-Version: 1.0 Content-Transfer-Encoding: 8bit Some of these chips have GNSS support. GNSS support is available through channel 9 whilst FM is through channel 8. Add a platform subdevice for GNSS so that a driver for that functionality can be build. To avoid having useless GNSS devices, do it only when the devicetree node name contains gnss. Signed-off-by: Andreas Kemnade Reviewed-by: Paul Menzel --- drivers/bluetooth/hci_ll.c | 81 ++++++++++++++++++++++++++++++++++++ include/linux/ti_wilink_st.h | 8 ++++ 2 files changed, 89 insertions(+) diff --git a/drivers/bluetooth/hci_ll.c b/drivers/bluetooth/hci_ll.c index 4a0b5c3160c2b..09e5a4dbd2f8c 100644 --- a/drivers/bluetooth/hci_ll.c +++ b/drivers/bluetooth/hci_ll.c @@ -32,6 +32,7 @@ #include #include #include +#include #include #include #include @@ -68,6 +69,9 @@ struct ll_device { struct gpio_desc *enable_gpio; struct clk *ext_clk; bdaddr_t bdaddr; + + void (*gnss_recv_func)(struct device *dev, struct sk_buff *skb); + struct platform_device *gnssdev; }; struct ll_struct { @@ -78,6 +82,8 @@ struct ll_struct { struct sk_buff_head tx_wait_q; /* HCILL wait queue */ }; +static int ll_gnss_register(struct ll_device *lldev); +static int ll_gnss_recv_frame(struct hci_dev *hdev, struct sk_buff *skb); /* * Builds and sends an HCILL command packet. * These are very simple packets with only 1 cmd byte @@ -411,6 +417,13 @@ static int ll_recv_frame(struct hci_dev *hdev, struct sk_buff *skb) .lsize = 0, \ .maxlen = 0 +#define LL_RECV_GNSS \ + .type = 9, \ + .hlen = 3, \ + .loff = 1, \ + .lsize = 2 + + static const struct h4_recv_pkt ll_recv_pkts[] = { { H4_RECV_ACL, .recv = hci_recv_frame }, { H4_RECV_SCO, .recv = hci_recv_frame }, @@ -419,6 +432,7 @@ static const struct h4_recv_pkt ll_recv_pkts[] = { { LL_RECV_SLEEP_ACK, .recv = ll_recv_frame }, { LL_RECV_WAKE_IND, .recv = ll_recv_frame }, { LL_RECV_WAKE_ACK, .recv = ll_recv_frame }, + { LL_RECV_GNSS, .recv = ll_gnss_recv_frame }, }; /* Recv data */ @@ -677,9 +691,69 @@ static int ll_setup(struct hci_uart *hu) } } + if (strstr(of_node_full_name(serdev->dev.of_node), "gnss")) + ll_gnss_register(lldev); + + return 0; +} + +struct hci_dev *st_get_hci(struct device *dev) +{ + struct ll_device *lldev = dev_get_drvdata(dev); + + return lldev->hu.hdev; +} +EXPORT_SYMBOL(st_get_hci); + +void st_set_gnss_recv_func(struct device *dev, + void (*recv_frame)(struct device *, struct sk_buff *)) +{ + struct ll_device *lldev = dev_get_drvdata(dev); + + lldev->gnss_recv_func = recv_frame; +} +EXPORT_SYMBOL(st_set_gnss_recv_func); + +static int ll_gnss_recv_frame(struct hci_dev *hdev, struct sk_buff *skb) +{ + struct hci_uart *hu = hci_get_drvdata(hdev); + struct ll_device *lldev = container_of(hu, struct ll_device, hu); + + if (!lldev->gnssdev) + return 0; + + if (lldev->gnss_recv_func) { + lldev->gnss_recv_func(&lldev->gnssdev->dev, skb); + return 0; + } + kfree_skb(skb); + return 0; } +static int ll_gnss_register(struct ll_device *lldev) +{ + struct platform_device *pdev; + int ret; + + pdev = platform_device_alloc("ti-ai2-gnss", PLATFORM_DEVID_AUTO); + if (!pdev) + return -ENOMEM; + + pdev->dev.parent = &lldev->serdev->dev; + lldev->gnssdev = pdev; + ret = platform_device_add(pdev); + if (ret) + goto err; + + return 0; + +err: + lldev->gnssdev = NULL; + platform_device_put(pdev); + return ret; +} + static const struct hci_uart_proto llp; static int hci_ti_probe(struct serdev_device *serdev) @@ -757,12 +831,19 @@ static int hci_ti_probe(struct serdev_device *serdev) } return hci_uart_register_device(hu, &llp); + + + return 0; } + static void hci_ti_remove(struct serdev_device *serdev) { struct ll_device *lldev = serdev_device_get_drvdata(serdev); + if (lldev->gnssdev) + platform_device_unregister(lldev->gnssdev); + hci_uart_unregister_device(&lldev->hu); } diff --git a/include/linux/ti_wilink_st.h b/include/linux/ti_wilink_st.h index 10642d4844f0c..eccc2db004069 100644 --- a/include/linux/ti_wilink_st.h +++ b/include/linux/ti_wilink_st.h @@ -381,6 +381,14 @@ unsigned long st_ll_getstate(struct st_data_s *); unsigned long st_ll_sleep_state(struct st_data_s *, unsigned char); void st_ll_wakeup(struct st_data_s *); +/** + * various funcs used to interact between FM, GPS and BT + */ +struct hci_dev *st_get_hci(struct device *dev); +void st_set_gnss_recv_func(struct device *dev, + void (*recv_frame)(struct device *, struct sk_buff *)); + + /* * header information used by st_core.c for FM and GPS * packet parsing, the bluetooth headers are already available -- 2.39.2