Received: by 2002:a25:6193:0:0:0:0:0 with SMTP id v141csp3492467ybb; Tue, 31 Mar 2020 06:25:46 -0700 (PDT) X-Google-Smtp-Source: ADFU+vt9Ff+GGKA0UP+7h2/8ybxHKI2yTXpx9UYeH0eh4rQkZ1kdXG284fmf4yczrzeCkAc/WU95 X-Received: by 2002:aca:4d47:: with SMTP id a68mr2173628oib.56.1585661146303; Tue, 31 Mar 2020 06:25:46 -0700 (PDT) ARC-Seal: i=2; a=rsa-sha256; t=1585661146; cv=pass; d=google.com; s=arc-20160816; b=KT6gKgSeTNVTfx2lVbQfHCmU7V4leQFNXB+u+YLpFPedT7D7ps9Oj+YN59rxLZJ549 XDF5YkmbQVuRETqnosFvHWAAOf55F/ec2hANyKvTyf1w82wa5DvmwzWQgkMH+3tSfUNp 5t0IyI4bgJqIqreD8/h5/jRmbnF/qyix5472b973XPwevgLoZP2MyWPjjMVv1mY4O2Ko fgxXnl+3SQ9zaquGwpwPqNm1TtfHsVPv2UFzH95bhiSv9Aa8W+Symt1I4RJap5fSvYwk wufHPFauZDNmFeSAL5aAr+JJduQSEs4RByFtWWMO90XYxoAFbEGAoViR6KEdYVCj7N8M lZ5Q== ARC-Message-Signature: i=2; a=rsa-sha256; c=relaxed/relaxed; d=google.com; s=arc-20160816; h=list-id:precedence:sender:mime-version:content-language :content-transfer-encoding:in-reply-to:user-agent:date:message-id :from:references:cc:to:subject:dkim-signature; bh=gCvPHVcv3FVKtaj4/u8oy+8gkiS6grFeRIiSiJoqFDE=; b=gWiUGprYUpo7cdNX8EfYNIOQAQFYfdcTihUmP1fNyGKcnrgqNYEAyEASaaN+IrsXlI 97g4lHFXI5pM26M4p1l4B/jK+xFg9v7k5snRSTurngQ9U1fGyRL61paY4DP+9ASWHY3F g00076MZjNKu6Iqn3sAmHqzCxYaJUNSFrDqGIHPiiSl7nktaFlVrnTmHsFj1/Wdp2Vo6 2KrmolLt+CPLIgW4arGv/yf360tZzjMcsMAinHv9kNtmUAGPYcXOv7sPuITL8kUlp8m3 BEwHLQXaDjIMrMEa4zSoWmWEDCcfMUCPYh9QDJ3KtC5kKtcNidLQZ2NvA1AxYX1ZMA9n Zg1A== ARC-Authentication-Results: i=2; mx.google.com; dkim=pass header.i=@amdcloud.onmicrosoft.com header.s=selector2-amdcloud-onmicrosoft-com header.b=MZ4aNL41; arc=pass (i=1 spf=pass spfdomain=amd.com dkim=pass dkdomain=amd.com dmarc=pass fromdomain=amd.com); spf=pass (google.com: best guess record for domain of linux-kernel-owner@vger.kernel.org designates 209.132.180.67 as permitted sender) smtp.mailfrom=linux-kernel-owner@vger.kernel.org Return-Path: Received: from vger.kernel.org (vger.kernel.org. [209.132.180.67]) by mx.google.com with ESMTP id y110si7899357otb.71.2020.03.31.06.25.32; Tue, 31 Mar 2020 06:25:46 -0700 (PDT) Received-SPF: pass (google.com: best guess record for domain of linux-kernel-owner@vger.kernel.org designates 209.132.180.67 as permitted sender) client-ip=209.132.180.67; Authentication-Results: mx.google.com; dkim=pass header.i=@amdcloud.onmicrosoft.com header.s=selector2-amdcloud-onmicrosoft-com header.b=MZ4aNL41; arc=pass (i=1 spf=pass spfdomain=amd.com dkim=pass dkdomain=amd.com dmarc=pass fromdomain=amd.com); spf=pass (google.com: best guess record for domain of linux-kernel-owner@vger.kernel.org designates 209.132.180.67 as permitted sender) smtp.mailfrom=linux-kernel-owner@vger.kernel.org Received: (majordomo@vger.kernel.org) by vger.kernel.org via listexpand id S1730851AbgCaNYJ (ORCPT + 99 others); Tue, 31 Mar 2020 09:24:09 -0400 Received: from mail-dm6nam10on2056.outbound.protection.outlook.com ([40.107.93.56]:35008 "EHLO NAM10-DM6-obe.outbound.protection.outlook.com" rhost-flags-OK-OK-OK-FAIL) by vger.kernel.org with ESMTP id S1730442AbgCaNYI (ORCPT ); Tue, 31 Mar 2020 09:24:08 -0400 ARC-Seal: i=1; a=rsa-sha256; s=arcselector9901; d=microsoft.com; cv=none; b=Mkqi0OtCzIM00WY5UMXU8cKo+NY/FzU+030M7Xnb0UwTsNBuUyMtpUxLJYhaeVDVNGYGOk55R2DmuBMFB+P5O7ldgcPdVe3kfHrR9TCZWTebNupIYDo6bFHHPmZjQtVAgnXQLj56CsoBTMjT2NFB1gUjoJCtRPBZLnEkPsJQNfusw8z5QuyarwE8BIjTP2ln9/giK3aUxLmVxF8E9cy25L6FO6Lmc2/z4rLs0mQkPDsHkEMXvYh5J0wkXqsWtEKnfnRiDF5wPTJYiCS0WXN225UNWWDFs8umlCzVqI/fGv/2Y4zza2AzJk+vVVet78HVyGWqKtIr6guUMYX7stEhNw== ARC-Message-Signature: i=1; a=rsa-sha256; c=relaxed/relaxed; d=microsoft.com; s=arcselector9901; h=From:Date:Subject:Message-ID:Content-Type:MIME-Version:X-MS-Exchange-SenderADCheck; bh=gCvPHVcv3FVKtaj4/u8oy+8gkiS6grFeRIiSiJoqFDE=; b=oYdV8ToqYcHreKXVegvuHlnocv5n8Oj+r5n+mS7oBumvkSxOSuWxbMphGp1ztOczjJ/+g/tkqO42rY+BePVtwL5Z10AB4ioaiOxYRPiwzmOujKDEn6AyPaKbAov0Zco2g6GBdyBgDeuS/caM/gwgazS1ziAfZkXCvZ0LKQRCcvVU+NLUdSGjkWVkNXpv8IJ+mwdRyg+lU5IAPio3sltKGJ32lOdUundpkCPzlW5ojlZnA7DkAo3T+kayO/J/9yBoqAU+3J7VNcTK18Utpx/1d2PYQ2nBzat93X/UU4yLOXZ48RRgx40pYA+Mhezzg9j43z7TkGJLxCAmpYaB2iYNBQ== ARC-Authentication-Results: i=1; mx.microsoft.com 1; spf=pass smtp.mailfrom=amd.com; dmarc=pass action=none header.from=amd.com; dkim=pass header.d=amd.com; arc=none DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=amdcloud.onmicrosoft.com; s=selector2-amdcloud-onmicrosoft-com; h=From:Date:Subject:Message-ID:Content-Type:MIME-Version:X-MS-Exchange-SenderADCheck; bh=gCvPHVcv3FVKtaj4/u8oy+8gkiS6grFeRIiSiJoqFDE=; b=MZ4aNL41pBrEMWg9LWw/MghC9t8ykLFhd5GUlBOqAfwckio3ndwErjMsiNLEjd4+CPkFbu/sYMN8W4h5tlkUQ4VVLX0LUefaAH5AXjIF8sLrP0bZyuAkb21OWggbFhOhoclPxQK9WW9IZEFDqzxuHgU7qY55CMg40ZJJWh1d4Ac= Authentication-Results: spf=none (sender IP is ) smtp.mailfrom=Nehal-bakulchandra.Shah@amd.com; Received: from BN6PR1201MB2467.namprd12.prod.outlook.com (2603:10b6:404:a7::8) by BN6PR1201MB2464.namprd12.prod.outlook.com (2603:10b6:404:ae::22) with Microsoft SMTP Server (version=TLS1_2, cipher=TLS_ECDHE_RSA_WITH_AES_256_GCM_SHA384) id 15.20.2856.20; Tue, 31 Mar 2020 13:19:28 +0000 Received: from BN6PR1201MB2467.namprd12.prod.outlook.com ([fe80::8daf:74d4:cbe4:759]) by BN6PR1201MB2467.namprd12.prod.outlook.com ([fe80::8daf:74d4:cbe4:759%12]) with mapi id 15.20.2856.019; Tue, 31 Mar 2020 13:19:28 +0000 Subject: Re: [PATCH v4 2/4] SFH: PCI driver to add support of AMD sensor fusion Hub using HID framework To: Richard Neumann , Sandeep Singh Cc: Shyam-sundar.S-k@amd.com, jikos@kernel.org, benjamin.tissoires@redhat.com, linux-kernel@vger.kernel.org, linux-input@vger.kernel.org, srinivas.pandruvada@linux.intel.com, jic23@kernel.org, linux-iio@vger.kernel.org, hdegoede@redhat.com References: <1582779537-25662-1-git-send-email-Sandeep.Singh@amd.com> <1582779537-25662-3-git-send-email-Sandeep.Singh@amd.com> <4fe47b0323c1d65d429ee89b000e8bfcd984495f.camel@richard-neumann.de> From: "Shah, Nehal-bakulchandra" Message-ID: <896f84bc-f0d6-59a5-c894-809695aa348f@amd.com> Date: Tue, 31 Mar 2020 18:48:54 +0530 User-Agent: Mozilla/5.0 (Windows NT 10.0; WOW64; rv:68.0) Gecko/20100101 Thunderbird/68.6.0 In-Reply-To: <4fe47b0323c1d65d429ee89b000e8bfcd984495f.camel@richard-neumann.de> Content-Type: text/plain; charset=utf-8 Content-Transfer-Encoding: 8bit Content-Language: en-US X-ClientProxiedBy: MAXPR0101CA0055.INDPRD01.PROD.OUTLOOK.COM (2603:1096:a00:e::17) To BN6PR1201MB2467.namprd12.prod.outlook.com (2603:10b6:404:a7::8) MIME-Version: 1.0 X-MS-Exchange-MessageSentRepresentingType: 1 Received: from [192.168.0.103] (202.62.82.154) by MAXPR0101CA0055.INDPRD01.PROD.OUTLOOK.COM (2603:1096:a00:e::17) with Microsoft SMTP Server (version=TLS1_2, cipher=TLS_ECDHE_RSA_WITH_AES_256_GCM_SHA384) id 15.20.2878.15 via Frontend Transport; Tue, 31 Mar 2020 13:19:12 +0000 X-Originating-IP: [202.62.82.154] X-MS-PublicTrafficType: Email X-MS-Office365-Filtering-HT: Tenant X-MS-Office365-Filtering-Correlation-Id: e0496f64-8348-4ae9-5a77-08d7d576237b X-MS-TrafficTypeDiagnostic: BN6PR1201MB2464:|BN6PR1201MB2464: X-MS-Exchange-Transport-Forked: True X-Microsoft-Antispam-PRVS: X-MS-Oob-TLC-OOBClassifiers: OLM:5797; X-Forefront-PRVS: 0359162B6D X-Forefront-Antispam-Report: CIP:255.255.255.255;CTRY:;LANG:en;SCL:1;SRV:;IPV:NLI;SFV:NSPM;H:BN6PR1201MB2467.namprd12.prod.outlook.com;PTR:;CAT:NONE;SFTY:;SFS:(10009020)(4636009)(136003)(346002)(396003)(376002)(366004)(39860400002)(16576012)(6666004)(4326008)(316002)(2616005)(26005)(81156014)(16526019)(2906002)(956004)(52116002)(186003)(36756003)(66946007)(31696002)(6486002)(53546011)(81166006)(6636002)(66476007)(86362001)(8676002)(5660300002)(66556008)(31686004)(110136005)(30864003)(478600001)(8936002)(55236004);DIR:OUT;SFP:1101; Received-SPF: None (protection.outlook.com: amd.com does not designate permitted sender hosts) X-MS-Exchange-SenderADCheck: 1 X-Microsoft-Antispam: BCL:0; X-Microsoft-Antispam-Message-Info: LJqzBJFDIji5QZkk8VCEZird/yudRbRM07zMCwg9N6Km8XQ+kbQXRyq7zT9ZizU5myMjBiTbqr+sd2InUdQVPw3oQDYXULwvA5nkyn+FM/JlHoJWbgTqnQFjWUs/LWS73e9BVfFGftX593ysnFNNnhVYchV185tM+GzKNOUh/fGDyoVAqSV6W0nDjMCkOJ5wSoPsUO4eYCC0awLZ/DPocpJ0j8UnTF7D6XWYFzLQsiHwl0S+dSDD+70kdbMg/Dk2OvIJSA/3QYYlOpOJHzwwUJfngQA5kPNfnpJyOOzkvNsdfj4fkXbPPsMpyWEWIPS9mdRZMfbK4opWTZO9GEY7LA0HfM38OBmvworZbyZvl/G/SBN/+pMxWtMdC/yZFGvdygsuo4No9N6JE9Eop2v9PWPiXHz0RamgQcir6dPmn7dsZiVSovMclSXf4luVItBD X-MS-Exchange-AntiSpam-MessageData: gtg8D2Uub6fEtQuMMIEIk7RawjQo7JMm26yjYssZvVCcpFcXDxjSbiz9LW+C4ti3fo+La5D+v9kGyDFqmQNgDrm6L16BG8wq539Fa5118J52FB/m5UL1oF9kNiZaMvJCZoG7SJGTmtnLw16yc//Zzg== X-OriginatorOrg: amd.com X-MS-Exchange-CrossTenant-Network-Message-Id: e0496f64-8348-4ae9-5a77-08d7d576237b X-MS-Exchange-CrossTenant-OriginalArrivalTime: 31 Mar 2020 13:19:27.9646 (UTC) X-MS-Exchange-CrossTenant-FromEntityHeader: Hosted X-MS-Exchange-CrossTenant-Id: 3dd8961f-e488-4e60-8e11-a82d994e183d X-MS-Exchange-CrossTenant-MailboxType: HOSTED X-MS-Exchange-CrossTenant-UserPrincipalName: 1tOP8OVEWrgv0yLKDxpoDZjgrKEQv8ngWlyIGzO7jwTW4Y8E9H/H7c2LBaZJAcCT X-MS-Exchange-Transport-CrossTenantHeadersStamped: BN6PR1201MB2464 Sender: linux-kernel-owner@vger.kernel.org Precedence: bulk List-ID: X-Mailing-List: linux-kernel@vger.kernel.org Hi Richard, On 3/31/2020 6:01 PM, Richard Neumann wrote: > Not a real review, but your patch series seems to be repeating a lot > from drivers/i2c/busses/i2c-amd-mp2*. > Is there any chance we could re-use the code? > E.g. the AMD_C2P_* definitions from drivers/i2c/busses/i2c-amd-mp2.h? Thanks for the mail. Yes there are some common structures, however as of now we have kept separately considering both are part of different sub systems. But may be will consider this input for future enhancement. Thanks Nehal Shah > > Am Donnerstag, den 27.02.2020, 10:28 +0530 schrieb Sandeep Singh: >> From: Sandeep Singh >> >> AMD SFH uses HID over PCIe bus.SFH fw is part of MP2 >> processor (MP2 which is an ARMĀ® Cortex-M4 core based >> co-processor to x86) and it runs on MP2 where in driver resides >> on X86. This part of module will communicate with MP2 FW and >> provide that data into DRAM >> >> Signed-off-by: Sandeep Singh >> Signed-off-by: Nehal Shah >> Reported-by: kbuild test robot >> --- >> drivers/hid/Kconfig | 2 + >> drivers/hid/Makefile | 1 + >> drivers/hid/amd-sfh-hid/Kconfig | 20 +++ >> drivers/hid/amd-sfh-hid/Makefile | 16 +++ >> drivers/hid/amd-sfh-hid/amd_mp2_pcie.c | 243 >> +++++++++++++++++++++++++++++++++ >> drivers/hid/amd-sfh-hid/amd_mp2_pcie.h | 176 >> ++++++++++++++++++++++++ >> 6 files changed, 458 insertions(+) >> create mode 100644 drivers/hid/amd-sfh-hid/Kconfig >> create mode 100644 drivers/hid/amd-sfh-hid/Makefile >> create mode 100644 drivers/hid/amd-sfh-hid/amd_mp2_pcie.c >> create mode 100644 drivers/hid/amd-sfh-hid/amd_mp2_pcie.h >> >> diff --git a/drivers/hid/Kconfig b/drivers/hid/Kconfig >> index 494a39e..b253ad1 100644 >> --- a/drivers/hid/Kconfig >> +++ b/drivers/hid/Kconfig >> @@ -1155,4 +1155,6 @@ source "drivers/hid/i2c-hid/Kconfig" >> >> source "drivers/hid/intel-ish-hid/Kconfig" >> >> +source "drivers/hid/amd-sfh-hid/Kconfig" >> + >> endmenu >> diff --git a/drivers/hid/Makefile b/drivers/hid/Makefile >> index bfefa36..15a08e8 100644 >> --- a/drivers/hid/Makefile >> +++ b/drivers/hid/Makefile >> @@ -139,3 +139,4 @@ obj-$(CONFIG_I2C_HID) += i2c-hid/ >> >> obj-$(CONFIG_INTEL_ISH_HID) += intel-ish-hid/ >> obj-$(INTEL_ISH_FIRMWARE_DOWNLOADER) += intel-ish-hid/ >> +obj-$(CONFIG_AMD_SFH_HID) += amd-sfh-hid/ >> diff --git a/drivers/hid/amd-sfh-hid/Kconfig b/drivers/hid/amd-sfh- >> hid/Kconfig >> new file mode 100644 >> index 0000000..7a224a1 >> --- /dev/null >> +++ b/drivers/hid/amd-sfh-hid/Kconfig >> @@ -0,0 +1,20 @@ >> +# SPDX-License-Identifier: GPL-2.0-only >> +menu "AMD SFH HID support" >> + depends on (X86_64 || COMPILE_TEST) && PCI >> + >> +config AMD_SFH_HID >> + tristate "AMD Sensor Fusion Hub" >> + select HID >> + help >> + If you say yes to this option, support will be included for the >> AMD >> + Sensor Fusion Hub. >> + This driver will enable sensors functionality to user through >> HID >> + framework. Basically this driver will get data from MP2 FW >> + and provide that data to HID framework. >> + MP2 which is an ARMĀ® Cortex-M4 core based co-processor to x86. >> + >> + This driver can also be built as modules. If so, the modules >> will >> + be called amd-mp2-pcie and amd-sfhtp-hid. >> + Say Y or M here if you want to support AMD SFH. If unsure, say >> N. >> + >> +endmenu >> diff --git a/drivers/hid/amd-sfh-hid/Makefile b/drivers/hid/amd-sfh- >> hid/Makefile >> new file mode 100644 >> index 0000000..fa38d84 >> --- /dev/null >> +++ b/drivers/hid/amd-sfh-hid/Makefile >> @@ -0,0 +1,16 @@ >> +# SPDX-License-Identifier: GPL-2.0 >> +# >> +# Makefile - AMD SFH HID drivers >> +# Copyright (c) 2020-2021, Advanced Micro Devices, Inc. >> +# >> +# >> +ccflags-m := -Werror >> +obj-$(CONFIG_AMD_SFH_HID) += amd-mp2-pcie.o >> +amd-mp2-pcie-objs := amd_mp2_pcie.o >> + >> +obj-$(CONFIG_AMD_SFH_HID) +=amd-sfhtp-hid.o >> +amd-sfhtp-hid-objs := amdsfh-hid.o >> +amd-sfhtp-hid-objs+= amdsfh-hid-client.o >> +amd-sfhtp-hid-objs+= hid_descriptor/amd_sfh_hid_descriptor.o >> + >> +ccflags-y += -I$(srctree)/$(src)/ >> diff --git a/drivers/hid/amd-sfh-hid/amd_mp2_pcie.c >> b/drivers/hid/amd-sfh-hid/amd_mp2_pcie.c >> new file mode 100644 >> index 0000000..c67f389 >> --- /dev/null >> +++ b/drivers/hid/amd-sfh-hid/amd_mp2_pcie.c >> @@ -0,0 +1,243 @@ >> +// SPDX-License-Identifier: GPL-2.0 >> +/* >> + * AMD MP2 PCIe communication driver >> + * >> + * Authors: Shyam Sundar S K >> + * Nehal Bakulchandra Shah > + */ >> + >> +#include >> +#include >> +#include >> +#include >> +#include >> +#include "amd_mp2_pcie.h" >> + >> +#define DRIVER_NAME "pcie_mp2_amd" >> +#define DRIVER_DESC "AMD(R) PCIe MP2 Communication Driver" >> + >> +#define ACEL_EN BIT(ACCEL_IDX) >> +#define GYRO_EN BIT(GYRO_IDX) >> +#define MAGNO_EN BIT(MAG_IDX) >> +#define ALS_EN BIT(AMBIENT_LIGHT_IDX) >> + >> +void amd_start_sensor(struct pci_dev *pdev, struct >> amd_mp2_sensor_info info) >> +{ >> + struct amd_mp2_dev *privdata = pci_get_drvdata(pdev); >> + union sfh_command_parameter cmd_param; >> + union sfh_cmd_base cmd_base; >> + >> + /*fill up command register*/ >> + cmd_base.ul = 0; >> + cmd_base.s.cmd_id = enable_sensor; >> + cmd_base.s.period = info.period; >> + cmd_base.s.sensor_id = info.sensor_idx; >> + >> + /*fill up command param register*/ >> + cmd_param.ul = 0; >> + cmd_param.s.buffer_layout = 1; >> + cmd_param.s.buffer_length = 16; >> + >> + write64((u64)info.phy_address, privdata->mmio + AMD_C2P_MSG2); >> + writel(cmd_param.ul, privdata->mmio + AMD_C2P_MSG1); >> + writel(cmd_base.ul, privdata->mmio + AMD_C2P_MSG0); >> +} >> +EXPORT_SYMBOL_GPL(amd_start_sensor); >> + >> +void amd_stop_sensor(struct pci_dev *pdev, u16 sensor_idx) >> +{ >> + struct amd_mp2_dev *privdata = pci_get_drvdata(pdev); >> + union sfh_cmd_base cmd_base; >> + >> + /* fill up command register */ >> + cmd_base.ul = 0; >> + cmd_base.s.cmd_id = disable_sensor; >> + cmd_base.s.period = 0; >> + cmd_base.s.sensor_id = sensor_idx; >> + >> + write64(0x0, privdata->mmio + AMD_C2P_MSG2); >> + writel(cmd_base.ul, privdata->mmio + AMD_C2P_MSG0); >> +} >> +EXPORT_SYMBOL_GPL(amd_stop_sensor); >> + >> +void amd_stop_all_sensors(struct pci_dev *pdev) >> +{ >> + struct amd_mp2_dev *privdata = pci_get_drvdata(pdev); >> + union sfh_cmd_base cmd_base; >> + >> + /*fill up command register */ >> + cmd_base.ul = 0; >> + cmd_base.s.cmd_id = stop_all_sensors; >> + cmd_base.s.period = 0; >> + cmd_base.s.sensor_id = 0; >> + >> + writel(cmd_base.ul, privdata->mmio + AMD_C2P_MSG0); >> +} >> +EXPORT_SYMBOL_GPL(amd_stop_all_sensors); >> + >> +int amd_mp2_get_sensor_num(struct pci_dev *dev, u8 *sensor_id) >> +{ >> + struct amd_mp2_dev *privdata = pci_get_drvdata(dev); >> + int activestatus; >> + int num_of_sensors = 0; >> + >> + if (!sensor_id) >> + return -ENOMEM; >> + >> + privdata->eventreg.activecontrolstatus = >> + readl(privdata->mmio + AMD_P2C_MSG3); >> + activestatus = privdata->eventreg.activecontrolstatus >> 4; >> + >> + if (ACEL_EN & activestatus) { >> + sensor_id[num_of_sensors] = ACCEL_IDX; >> + num_of_sensors++; >> + } >> + if (GYRO_EN & activestatus) { >> + sensor_id[num_of_sensors] = GYRO_IDX; >> + num_of_sensors++; >> + } >> + if (MAGNO_EN & activestatus) { >> + sensor_id[num_of_sensors] = MAG_IDX; >> + num_of_sensors++; >> + } >> + >> + if (ALS_EN & activestatus) { >> + sensor_id[num_of_sensors] = AMBIENT_LIGHT_IDX; >> + num_of_sensors++; >> + } >> + >> + return num_of_sensors; >> +} >> +EXPORT_SYMBOL_GPL(amd_mp2_get_sensor_num); >> + >> +static int amd_mp2_pci_init(struct amd_mp2_dev *privdata, struct >> pci_dev *pdev) >> +{ >> + int rc; >> + int bar_index = 2; >> + resource_size_t size, base; >> + >> + pci_set_drvdata(pdev, privdata); >> + >> + rc = pcim_enable_device(pdev); >> + if (rc) >> + goto err_pci_enable; >> + >> + rc = pcim_iomap_regions(pdev, 1 >> 2, DRIVER_NAME); >> + if (rc) >> + goto err_pci_regions; >> + >> + privdata->mmio = pcim_iomap_table(pdev)[2]; >> + pci_set_master(pdev); >> + >> + rc = pci_set_dma_mask(pdev, DMA_BIT_MASK(64)); >> + if (rc) { >> + rc = pci_set_dma_mask(pdev, DMA_BIT_MASK(32)); >> + if (rc) >> + goto err_dma_mask; >> + } >> + >> + rc = pci_set_consistent_dma_mask(pdev, DMA_BIT_MASK(64)); >> + if (rc) { >> + rc = pci_set_consistent_dma_mask(pdev, >> DMA_BIT_MASK(32)); >> + if (rc) >> + goto err_dma_mask; >> + } >> + >> + base = pci_resource_start(pdev, bar_index); >> + size = pci_resource_len(pdev, bar_index); >> + dev_dbg(ndev_dev(privdata), "Base addr:%llx size:%llx\n", >> + (unsigned long long)base, (unsigned long long)size); >> + >> + privdata->mmio = ioremap(base, size); >> + if (!privdata->mmio) { >> + rc = -EIO; >> + goto err_dma_mask; >> + } >> + >> + return 0; >> + >> +err_dma_mask: >> + pci_clear_master(pdev); >> +err_pci_regions: >> + pci_disable_device(pdev); >> +err_pci_enable: >> + pci_set_drvdata(pdev, NULL); >> + return rc; >> +} >> + >> +static void amd_mp2_pci_deinit(struct amd_mp2_dev *privdata) >> +{ >> + struct pci_dev *pdev = ndev_pdev(privdata); >> + >> + amd_stop_all_sensors(pdev); >> + pci_iounmap(pdev, privdata->mmio); >> + >> + pci_clear_master(pdev); >> + pci_disable_device(pdev); >> + pci_set_drvdata(pdev, NULL); >> +} >> + >> +static int amd_mp2_pci_probe(struct pci_dev *pdev, >> + const struct pci_device_id *id) >> +{ >> + struct amd_mp2_dev *privdata; >> + int rc; >> + >> + dev_info(&pdev->dev, "MP2 device found [%04x:%04x] (rev %x)\n", >> + (int)pdev->vendor, (int)pdev->device, (int)pdev- >>> revision); >> + >> + privdata = devm_kzalloc(&pdev->dev, sizeof(*privdata), >> GFP_KERNEL); >> + >> + if (!privdata) { >> + rc = -ENOMEM; >> + goto err_dev; >> + } >> + >> + privdata->pdev = pdev; >> + >> + rc = amd_mp2_pci_init(privdata, pdev); >> + if (rc) >> + goto err_pci_init; >> + return 0; >> + >> +err_pci_init: >> + return rc; >> +err_dev: >> + return rc; >> +} >> + >> +static void amd_mp2_pci_remove(struct pci_dev *pdev) >> +{ >> + struct amd_mp2_dev *privdata = pci_get_drvdata(pdev); >> + >> + amd_mp2_pci_deinit(privdata); >> +} >> + >> +static const struct pci_device_id amd_mp2_pci_tbl[] = { >> + {PCI_VDEVICE(AMD, PCI_DEVICE_ID_AMD_MP2)}, >> + {0} >> +}; >> +MODULE_DEVICE_TABLE(pci, amd_mp2_pci_tbl); >> + >> +static struct pci_driver amd_mp2_pci_driver = { >> + .name = DRIVER_NAME, >> + .id_table = amd_mp2_pci_tbl, >> + .probe = amd_mp2_pci_probe, >> + .remove = amd_mp2_pci_remove, >> +}; >> + >> +static int __init amd_mp2_pci_driver_init(void) >> +{ >> + return pci_register_driver(&amd_mp2_pci_driver); >> +} >> +module_init(amd_mp2_pci_driver_init); >> + >> +static void __exit amd_mp2_pci_driver_exit(void) >> +{ >> + pci_unregister_driver(&amd_mp2_pci_driver); >> +} >> +module_exit(amd_mp2_pci_driver_exit); >> +MODULE_DESCRIPTION(DRIVER_DESC); >> +MODULE_LICENSE("Dual BSD/GPL"); >> +MODULE_AUTHOR("Shyam Sundar S K "); >> +MODULE_AUTHOR("Nehal Bakulchandra Shah < >> Nehal-bakulchandra.Shah@amd.com>"); >> diff --git a/drivers/hid/amd-sfh-hid/amd_mp2_pcie.h >> b/drivers/hid/amd-sfh-hid/amd_mp2_pcie.h >> new file mode 100644 >> index 0000000..3ba69ac >> --- /dev/null >> +++ b/drivers/hid/amd-sfh-hid/amd_mp2_pcie.h >> @@ -0,0 +1,176 @@ >> +/* SPDX-License-Identifier: GPL-2.0 >> + * >> + * AMD MP2 PCIe communication driver >> + * >> + * Authors: Shyam Sundar S K >> + * Nehal Bakulchandra Shah > + */ >> + >> +#ifndef PCIE_MP2_AMD_H >> +#define PCIE_MP2_AMD_H >> + >> +#include >> +#define PCI_DEVICE_ID_AMD_MP2 0x15E4 >> + >> +/* MP2 C2P Message Registers */ >> +#define AMD_C2P_MSG0 0x10500 >> +#define AMD_C2P_MSG1 0x10504 >> +#define AMD_C2P_MSG2 0x10508 >> +#define AMD_C2P_MSG3 0x1050c >> +#define AMD_C2P_MSG4 0x10510 >> +#define AMD_C2P_MSG5 0x10514 >> +#define AMD_C2P_MSG6 0x10518 >> +#define AMD_C2P_MSG7 0x1051c >> +#define AMD_C2P_MSG8 0x10520 >> +#define AMD_C2P_MSG9 0x10524 >> + >> +/* MP2 P2C Message Registers */ >> +#define AMD_P2C_MSG0 0x10680 /*Do not use*/ >> +#define AMD_P2C_MSG1 0x10684 >> +#define AMD_P2C_MSG2 0x10688 >> +#define AMD_P2C_MSG3 0x1068C /*MP2 debug info*/ >> +#define AMD_P2C_MSG_INTEN 0x10690 /*MP2 int gen register*/ >> +#define AMD_P2C_MSG_INTSTS 0x10694 /*Interrupt sts*/ >> + >> +#define write64 amdsfh_write64 >> +static inline void amdsfh_write64(u64 val, void __iomem *mmio) >> +{ >> + writel(val, mmio); >> + writel(val >> 32, mmio + sizeof(u32)); >> +} >> + >> +#define read64 amdsfh_read64 >> +static inline u64 amdsfh_read64(void __iomem *mmio) >> +{ >> + u64 low, high; >> + >> + low = readl(mmio); >> + high = readl(mmio + sizeof(u32)); >> + return low | (high << 32); >> +} >> + >> +/* >> + * SFH Command registers >> + */ >> +union sfh_cmd_base { >> + u32 ul; >> + struct { >> + u32 cmd_id : 8; >> + u32 sensor_id : 8; >> + u32 period : 16; >> + } s; >> +}; >> + >> +union sfh_command_parameter { >> + u32 ul; >> + struct { >> + u32 buffer_layout : 2; >> + u32 buffer_length : 6; >> + u32 rsvd : 24; >> + } s; >> +}; >> + >> +struct sfh_command_register { >> + union sfh_cmd_base cmd_base; >> + union sfh_command_parameter cmd_param; >> + phys_addr_t phy_addr; >> +}; >> + >> +/* >> + * SFH Response registers >> + */ >> +enum response_type { >> + non_operationevent, >> + command_success, >> + command_failed, >> + sfi_dataready_event, >> + invalid_response = 0xff, >> +}; >> + >> +enum status_type { >> + cmd_success, >> + invalid_data_payload, >> + invalid_data_length, >> + invalid_sensor_id, >> + invalid_dram_addr, >> + invalid_command, >> + sensor_enabled, >> + sensor_disabled, >> + status_end, >> +}; >> + >> +enum command_id { >> + non_operation = 0, >> + enable_sensor = 1, >> + disable_sensor = 2, >> + dump_sensorinfo = 3, >> + numberof_sensordiscovered = 4, >> + who_am_i_regchipid = 5, >> + set_dcd_data = 6, >> + get_dcd_data = 7, >> + stop_all_sensors = 8, >> + invalid_cmd = 0xf, >> +}; >> + >> +/** >> + * union sfh_event_base : bit access of C2P commands >> + * @response: bit: 0..3 SFI response_type >> + * @status: bit: 6..5 status_type >> + * @out_in_c2p: bit: 5 0- output in DRAM,1-in C2PMsg >> + * @length: bit: 8..13 length >> + * @dbg:bit: 14.15 dbg msg include in p2c msg 1-2 >> + * @sensor_id:bit: 16..23 Sensor ID >> + * @rsvd:bit: 24..31 Reservered for future use >> + */ >> +union sfh_event_base { >> + u32 ul; >> + struct { >> + u32 response : 4; >> + u32 status : 3; >> + u32 out_in_c2p : 1; >> + u32 length : 6; >> + u32 dbg : 2; >> + u32 sensor_id : 8; >> + u32 rsvd : 8; >> + } s; >> +}; >> + >> +struct sfi_event_register { >> + union sfh_event_base evtbase; >> + u32 debuginfo1; >> + u32 debuginfo2; >> + u32 activecontrolstatus; >> +}; >> + >> +enum sensor_idx { >> + ACCEL_IDX = 0, >> + GYRO_IDX = 1, >> + MAG_IDX = 2, >> + AMBIENT_LIGHT_IDX = 19, >> + NUM_ALL_SENSOR_CONSUMERS >> +}; >> + >> +struct amd_mp2_dev { >> + struct pci_dev *pdev; >> + void __iomem *mmio; >> + union sfh_event_base eventval; >> + struct sfi_event_register eventreg; >> + struct delayed_work work; >> + void *ctx; >> + void *cl_data; >> +}; >> + >> +struct amd_mp2_sensor_info { >> + u8 sensor_idx; >> + u32 period; >> + phys_addr_t phy_address; >> +}; >> + >> +void amd_start_sensor(struct pci_dev *pdev, struct >> amd_mp2_sensor_info info); >> +void amd_stop_sensor(struct pci_dev *pdev, u16 sensor_idx); >> +void amd_stop_all_sensors(struct pci_dev *pdev); >> +int amd_mp2_get_sensor_num(struct pci_dev *dev, u8 *sensor_id); >> +#define ndev_pdev(ndev) ((ndev)->pdev) >> +#define ndev_name(ndev) pci_name(ndev_pdev(ndev)) >> +#define ndev_dev(ndev) (&ndev_pdev(ndev)->dev) >> +#endif