redonkable
/
alistair23-linux
1
0
Fork 0
Code Releases Activity

sim: emvsim: add multi power domain support 

Add multi power domain support for emvsim as it needs power domain both
SOC and Board level.

Signed-off-by: Joakim Zhang <qiangqing.zhang@nxp.com>
5.4-rM2-2.2.x-imx-squashed
Joakim Zhang 2019-10-10 19:12:24 +08:00 committed by Dong Aisheng
parent b3e7783229
commit 7a059a09be
1 changed files with 44 additions and 0 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

44
drivers/mxc/sim/imx_emvsim.c
View File

@ -30,6 +30,7 @@
#include <linux/time.h>
#include <linux/types.h>
#include <linux/pinctrl/consumer.h>
#include <linux/pm_domain.h>
#define DRIVER_NAME "mxc_emvsim"
@ -200,6 +201,10 @@ struct emvsim_t {
u32 clk_rate;
u8 checking_ts_timing;
u8 tx_last_character;
/* multiple power domain for emvsim */
struct device *sim_pd;
struct device *sim_aux_pd;
};
static struct miscdevice emvsim_dev;
@ -1535,6 +1540,41 @@ static const struct of_device_id emvsim_imx_dt_ids[] = {
MODULE_DEVICE_TABLE(of, emvsim_imx_dt_ids);
static int emvsim_attach_multi_pd(struct device *dev, struct emvsim_t *emvsim)
{
struct device_link *link;
/* Do nothing when in a signal power domain */
if (dev->pm_domain)
return 0;
emvsim->sim_pd = dev_pm_domain_attach_by_name(dev, "sim_pd");
if (IS_ERR(emvsim->sim_pd))
return PTR_ERR(emvsim->sim_pd);
link = device_link_add(dev, emvsim->sim_pd,
DL_FLAG_STATELESS |
DL_FLAG_PM_RUNTIME |
DL_FLAG_RPM_ACTIVE);
if (IS_ERR(link)) {
dev_err(dev, "Failed to add device_link to EMVSIM pd: %ld\n", PTR_ERR(link));
return PTR_ERR(link);
}
emvsim->sim_aux_pd = dev_pm_domain_attach_by_name(dev, "sim_aux_pd");
if (IS_ERR(emvsim->sim_aux_pd))
return PTR_ERR(emvsim->sim_aux_pd);
link = device_link_add(dev, emvsim->sim_aux_pd,
DL_FLAG_STATELESS |
DL_FLAG_PM_RUNTIME |
DL_FLAG_RPM_ACTIVE);
if (IS_ERR(link)) {
dev_err(dev, "Failed to add device_link to EMVSIM pd: %ld\n", PTR_ERR(link));
return PTR_ERR(link);
}
return 0;
}
static int emvsim_probe(struct platform_device *pdev)
{
int ret = 0;
@ -1598,6 +1638,10 @@ static int emvsim_probe(struct platform_device *pdev)
platform_set_drvdata(pdev, emvsim);
emvsim_dev.parent = &pdev->dev;
ret = emvsim_attach_multi_pd(&pdev->dev, emvsim);
if (ret)
return ret;
ret = misc_register(&emvsim_dev);
dev_info(&pdev->dev, "emvsim register %s\n", ret ? "fail" : "success");