From mboxrd@z Thu Jan 1 00:00:00 1970 Return-Path: X-Spam-Checker-Version: SpamAssassin 3.4.1 (2015-04-28) on sa.local.altlinux.org X-Spam-Level: X-Spam-Status: No, score=-4.3 required=5.0 tests=ALL_TRUSTED,BAYES_00, RP_MATCHES_RCVD autolearn=ham autolearn_force=no version=3.4.1 From: Alexey Sheplyakov To: devel-kernel@lists.altlinux.org Date: Wed, 14 Dec 2022 17:19:03 +0400 Message-Id: <20221214131919.681481-16-asheplyakov@basealt.ru> X-Mailer: git-send-email 2.33.5 In-Reply-To: <20221214131919.681481-1-asheplyakov@basealt.ru> References: <20221214131919.681481-1-asheplyakov@basealt.ru> MIME-Version: 1.0 Content-Transfer-Encoding: 8bit Cc: =?UTF-8?q?=D0=A0=D0=BE=D0=BC=D0=B0=D0=BD=20=D0=A1=D1=82=D0=B0=D0=B2=D1=86=D0=B5=D0=B2?= , =?UTF-8?q?=D0=98=D0=B3=D0=BE=D1=80=D1=8C=20=D0=A7=D1=83=D0=B4=D0=BE=D0=B2?= , =?UTF-8?q?=D0=95=D0=B2=D0=B3=D0=B5=D0=BD=D0=B8=D0=B9=20=D0=A1=D0=B8=D0=BD=D0=B5=D0=BB=D1=8C=D0=BD=D0=B8=D0=BA=D0=BE=D0=B2?= , =?UTF-8?q?=D0=94=D0=BC=D0=B8=D1=82=D1=80=D0=B8=D0=B9=20=D0=A2=D0=B5=D1=80=D1=91=D1=85=D0=B8=D0=BD?= Subject: [d-kernel] [PATCH 16/32] hwmon: bt1-pvt: define pvt_readl/pvt_writel for Baikal-M SoC X-BeenThere: devel-kernel@lists.altlinux.org X-Mailman-Version: 2.1.12 Precedence: list Reply-To: ALT Linux kernel packages development List-Id: ALT Linux kernel packages development List-Unsubscribe: , List-Archive: List-Post: List-Help: List-Subscribe: , X-List-Received-Date: Wed, 14 Dec 2022 13:20:23 -0000 Archived-At: List-Archive: List-Post: On Baikal-M Linux has to call into firmware (ARM-TF) to access PVT registers. Signed-off-by: Alexey Sheplyakov X-feature-Baikal-M --- drivers/hwmon/bt1-pvt.c | 23 +++++++++++++++++++++++ drivers/hwmon/bt1-pvt.h | 8 ++++++++ 2 files changed, 31 insertions(+) diff --git a/drivers/hwmon/bt1-pvt.c b/drivers/hwmon/bt1-pvt.c index 4668e9d10f0d..fa91be300c3b 100644 --- a/drivers/hwmon/bt1-pvt.c +++ b/drivers/hwmon/bt1-pvt.c @@ -30,6 +30,9 @@ #include #include #include +#ifdef CONFIG_ARM64 +#include +#endif #include "bt1-pvt.h" @@ -115,6 +118,7 @@ static const struct polynomial poly_N_to_volt = { }; +#ifdef BT1_PVT_DIRECT_REG_ACCESS static inline u32 pvt_readl(struct pvt_hwmon const *pvt, int reg) { return readl(pvt->regs + reg); } @@ -126,6 +130,25 @@ static inline u32 pvt_readl_relaxed(struct pvt_hwmon const *pvt, int reg) { static inline void pvt_writel(u32 data, struct pvt_hwmon const *pvt, int reg) { writel(data, pvt->regs + reg); } +#else +static inline u32 pvt_readl(struct pvt_hwmon const *pvt, int reg) { + struct arm_smccc_res res; + arm_smccc_smc(BAIKAL_SMC_PVT_ID, PVT_READ, pvt->pvt_id, reg, + 0, 0, 0, 0, &res); + return res.a0; +} + +static inline u32 pvt_readl_relaxed(struct pvt_hwmon const *pvt, int reg) { + return pvt_readl(pvt, reg); +} + +static inline void pvt_writel(u32 data, struct pvt_hwmon const *pvt, int reg) { + struct arm_smccc_res res; + arm_smccc_smc(BAIKAL_SMC_PVT_ID, PVT_WRITE, pvt->pvt_id, reg, + data, 0, 0, 0, &res); +} +#endif + static inline u32 pvt_update(struct pvt_hwmon *pvt, int reg, u32 mask, u32 data) { u32 old; diff --git a/drivers/hwmon/bt1-pvt.h b/drivers/hwmon/bt1-pvt.h index 93b8dd5e7c94..0cea95b01c13 100644 --- a/drivers/hwmon/bt1-pvt.h +++ b/drivers/hwmon/bt1-pvt.h @@ -101,6 +101,13 @@ # define PVT_TOUT_DEF 0 #endif +#define BAIKAL_SMC_PVT_ID 0x82000001 +#define PVT_READ 0 +#define PVT_WRITE 1 +#ifndef CONFIG_ARM64 +#define BT1_PVT_DIRECT_REG_ACCESS +#endif + /* * enum pvt_sensor_type - Baikal-T1 PVT sensor types (correspond to each PVT * sampling mode) @@ -217,6 +224,7 @@ struct pvt_hwmon { enum pvt_sensor_type sensor; struct pvt_cache cache[PVT_SENSORS_NUM]; ktime_t timeout; + int pvt_id; }; /* -- 2.33.5