#include <linux/auxiliary_bus.h>
#include <linux/module.h>
#include <linux/of.h>
#include <linux/pwrseq/provider.h>
#include <linux/regmap.h>
#define SYS_PWRRDY_N 0xd70
#define SYS_PWRRDY_N_USB_MASK BIT(0)
#define SYS_PWRRDY_N_DSI_MASK BIT(1)
#define SYS_PWRRDY_N_CSI_MASK BIT(2)
static int pwrseq_rzg3l_set_pwrrdy(struct pwrseq_device *pwrseq, u32 mask,
bool val)
{
struct regmap *regmap = pwrseq_device_get_drvdata(pwrseq);
return regmap_assign_bits(regmap, SYS_PWRRDY_N, mask, val);
}
static int pwrseq_rzg3l_usb_pwrrdy_enable(struct pwrseq_device *pwrseq)
{
return pwrseq_rzg3l_set_pwrrdy(pwrseq, SYS_PWRRDY_N_USB_MASK, 0);
}
static int pwrseq_rzg3l_usb_pwrrdy_disable(struct pwrseq_device *pwrseq)
{
return pwrseq_rzg3l_set_pwrrdy(pwrseq, SYS_PWRRDY_N_USB_MASK, 1);
}
static const struct pwrseq_unit_data pwrseq_rzg3l_usb_pwrrdy_unit = {
.name = "usb-pwrrdy-power-sequence",
.enable = pwrseq_rzg3l_usb_pwrrdy_enable,
.disable = pwrseq_rzg3l_usb_pwrrdy_disable,
};
static int pwrseq_rzg3l_dsi_pwrrdy_enable(struct pwrseq_device *pwrseq)
{
return pwrseq_rzg3l_set_pwrrdy(pwrseq, SYS_PWRRDY_N_DSI_MASK, 0);
}
static int pwrseq_rzg3l_dsi_pwrrdy_disable(struct pwrseq_device *pwrseq)
{
return pwrseq_rzg3l_set_pwrrdy(pwrseq, SYS_PWRRDY_N_DSI_MASK, 1);
}
static const struct pwrseq_unit_data pwrseq_rzg3l_dsi_pwrrdy_unit = {
.name = "dsi-pwrrdy-sequence",
.enable = pwrseq_rzg3l_dsi_pwrrdy_enable,
.disable = pwrseq_rzg3l_dsi_pwrrdy_disable,
};
static int pwrseq_rzg3l_csi_pwrrdy_enable(struct pwrseq_device *pwrseq)
{
return pwrseq_rzg3l_set_pwrrdy(pwrseq, SYS_PWRRDY_N_CSI_MASK, 0);
}
static int pwrseq_rzg3l_csi_pwrrdy_disable(struct pwrseq_device *pwrseq)
{
return pwrseq_rzg3l_set_pwrrdy(pwrseq, SYS_PWRRDY_N_CSI_MASK, 1);
}
static const struct pwrseq_unit_data pwrseq_rzg3l_csi_pwrrdy_unit = {
.name = "csi-pwrrdy-power-sequence",
.enable = pwrseq_rzg3l_csi_pwrrdy_enable,
.disable = pwrseq_rzg3l_csi_pwrrdy_disable,
};
static const struct pwrseq_target_data pwrseq_rzg3l_usb_pwrrdy_target = {
.name = "usb-pwrrdy",
.unit = &pwrseq_rzg3l_usb_pwrrdy_unit,
};
static const struct pwrseq_target_data pwrseq_rzg3l_dsi_pwrrdy_target = {
.name = "dsi-pwrrdy",
.unit = &pwrseq_rzg3l_dsi_pwrrdy_unit,
};
static const struct pwrseq_target_data pwrseq_rzg3l_csi_pwrrdy_target = {
.name = "csi-pwrrdy",
.unit = &pwrseq_rzg3l_csi_pwrrdy_unit,
};
static const struct pwrseq_target_data *pwrseq_rzg3l_pwrrdy_targets[] = {
&pwrseq_rzg3l_usb_pwrrdy_target,
&pwrseq_rzg3l_dsi_pwrrdy_target,
&pwrseq_rzg3l_csi_pwrrdy_target,
NULL
};
static const char * const pwrseq_rzg3l_pwrrdy_compats[] = {
"renesas,r9a08g046-usbphy-ctrl",
"renesas,r9a08g046-mipi-dsi",
NULL
};
static int pwrseq_rzg3l_pwrrdy_match(struct pwrseq_device *pwrseq,
struct device *dev)
{
if (of_device_compatible_match(dev->of_node, pwrseq_rzg3l_pwrrdy_compats))
return PWRSEQ_MATCH_OK;
return PWRSEQ_NO_MATCH;
}
static int pwrseq_rzg3l_pwrrdy_probe(struct auxiliary_device *adev,
const struct auxiliary_device_id *id)
{
struct pwrseq_config config = {
.parent = &adev->dev,
.owner = THIS_MODULE,
.drvdata = adev->dev.platform_data,
.match = pwrseq_rzg3l_pwrrdy_match,
.targets = pwrseq_rzg3l_pwrrdy_targets,
};
return PTR_ERR_OR_ZERO(devm_pwrseq_device_register(&adev->dev, &config));
}
static const struct auxiliary_device_id pwrseq_rzg3l_pwrrdy_id_table[] = {
{ .name = "rz_sysc.pwrseq-pwrrdy" },
{ }
};
MODULE_DEVICE_TABLE(auxiliary, pwrseq_rzg3l_pwrrdy_id_table);
static struct auxiliary_driver pwrseq_rzg3l_pwrrdy_driver = {
.driver = {
.name = "pwrseq-rzg3l-pwrrdy",
},
.probe = pwrseq_rzg3l_pwrrdy_probe,
.id_table = pwrseq_rzg3l_pwrrdy_id_table,
};
module_auxiliary_driver(pwrseq_rzg3l_pwrrdy_driver);
MODULE_AUTHOR("Biju Das <biju.das.jz@bp.renesas.com>");
MODULE_DESCRIPTION("Renesas RZ/G3L Power Ready Driver");
MODULE_LICENSE("GPL"