soc/qcom/qcom-pbs.c

14 #include <linux/soc/qcom/qcom-pbs.h>
34 static int qcom_pbs_wait_for_ack(struct pbs_dev *pbs, u8 bit_pos)
39 	ret = regmap_read_poll_timeout(pbs->regmap,  pbs->base + PBS_CLIENT_SCRATCH2,
43 		dev_err(pbs->dev, "Timeout for PBS ACK/NACK for bit %u\n", bit_pos);
48 		ret = regmap_write(pbs->regmap, pbs->base + PBS_CLIENT_SCRATCH2, 0);
49 		dev_err(pbs->dev, "NACK from PBS for bit %u\n", bit_pos);
53 	dev_dbg(pbs->dev, "PBS sequence for bit %u executed!\n", bit_pos);
59  * @pbs: Pointer to PBS device
74 int qcom_pbs_trigger_event(struct pbs_dev *pbs, u8 bitmap)
83 	if (IS_ERR_OR_NULL(pbs))
86 	mutex_lock(&pbs->lock);
87 	ret = regmap_read(pbs->regmap, pbs->base + PBS_CLIENT_SCRATCH2, &val);
93 		ret = regmap_write(pbs->regmap, pbs->base + PBS_CLIENT_SCRATCH2, 0);
103 		ret = regmap_update_bits(pbs->regmap, pbs->base + PBS_CLIENT_SCRATCH2,
109 		ret = regmap_update_bits(pbs->regmap, pbs->base + PBS_CLIENT_SCRATCH1,
115 		ret = regmap_update_bits(pbs->regmap, pbs->base + PBS_CLIENT_TRIG_CTL,
120 		ret = qcom_pbs_wait_for_ack(pbs, bit_pos);
125 		regmap_update_bits(pbs->regmap, pbs->base + PBS_CLIENT_SCRATCH1, BIT(bit_pos), 0);
126 		regmap_update_bits(pbs->regmap, pbs->base + PBS_CLIENT_SCRATCH2, BIT(bit_pos), 0);
131 	ret = regmap_update_bits(pbs->regmap, pbs->base + PBS_CLIENT_SCRATCH1, bitmap, 0);
134 	mutex_unlock(&pbs->lock);
153 	struct pbs_dev *pbs;
155 	pbs_dev_node = of_parse_phandle(dev->of_node, "qcom,pbs", 0);
157 		dev_err(dev, "Missing qcom,pbs property\n");
164 		pbs = ERR_PTR(-EPROBE_DEFER);
168 	pbs = platform_get_drvdata(pdev);
169 	if (!pbs) {
170 		dev_err(dev, "Cannot get pbs instance from %s\n", dev_name(&pdev->dev));
172 		pbs = ERR_PTR(-EPROBE_DEFER);
176 	pbs->link = device_link_add(dev, &pdev->dev, DL_FLAG_AUTOREMOVE_SUPPLIER);
177 	if (!pbs->link) {
180 		pbs = ERR_PTR(-EINVAL);
186 	return pbs;
192 	struct pbs_dev *pbs;
196 	pbs = devm_kzalloc(&pdev->dev, sizeof(*pbs), GFP_KERNEL);
197 	if (!pbs)
200 	pbs->dev = &pdev->dev;
201 	pbs->regmap = dev_get_regmap(pbs->dev->parent, NULL);
202 	if (!pbs->regmap) {
203 		dev_err(pbs->dev, "Couldn't get parent's regmap\n");
207 	ret = device_property_read_u32(pbs->dev, "reg", &val);
209 		dev_err(pbs->dev, "Couldn't find reg, ret = %d\n", ret);
212 	pbs->base = val;
213 	mutex_init(&pbs->lock);
215 	platform_set_drvdata(pdev, pbs);
221 	{ .compatible = "qcom,pbs" },
228 		.name		= "qcom-pbs",