Orange Pi5 kernel

^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  1) // SPDX-License-Identifier: GPL-2.0+
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  2) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  3)  * Actions Semi Owl Smart Power System (SPS) shared helpers
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  4)  *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  5)  * Copyright 2012 Actions Semi Inc.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  6)  * Author: Actions Semi, Inc.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  7)  *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  8)  * Copyright (c) 2017 Andreas Färber
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  9)  */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 10) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 11) #include <linux/delay.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 12) #include <linux/io.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 13) #include <linux/soc/actions/owl-sps.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 14) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 15) #define OWL_SPS_PG_CTL	0x0
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 16) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 17) int owl_sps_set_pg(void __iomem *base, u32 pwr_mask, u32 ack_mask, bool enable)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 18) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 19) 	u32 val;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 20) 	bool ack;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 21) 	int timeout;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 22) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 23) 	val = readl(base + OWL_SPS_PG_CTL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 24) 	ack = val & ack_mask;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 25) 	if (ack == enable)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 26) 		return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 27) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 28) 	if (enable)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 29) 		val |= pwr_mask;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 30) 	else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 31) 		val &= ~pwr_mask;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 32) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 33) 	writel(val, base + OWL_SPS_PG_CTL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 34) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 35) 	for (timeout = 5000; timeout > 0; timeout -= 50) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 36) 		val = readl(base + OWL_SPS_PG_CTL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 37) 		if ((val & ack_mask) == (enable ? ack_mask : 0))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 38) 			break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 39) 		udelay(50);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 40) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 41) 	if (timeout <= 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 42) 		return -ETIMEDOUT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 43) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 44) 	udelay(10);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 45) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 46) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 47) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 48) EXPORT_SYMBOL_GPL(owl_sps_set_pg);