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