mirror of
https://github.com/hardkernel/kernel_common_drivers.git
synced 2026-06-25 12:03:48 +09:00
hongyu.chen1
9bc782cfb7
PD#SWPL-108716 Problem: need power domain. Solution: add power domain. Verify: ax201 Change-Id: Idc0638e90001f82eb4830b6a2f356cde9e5c5d13 Signed-off-by: hongyu.chen1 <hongyu.chen1@amlogic.com>
123 lines
2.7 KiB
C
123 lines
2.7 KiB
C
// SPDX-License-Identifier: (GPL-2.0+ OR MIT)
|
|
/*
|
|
* Copyright (c) 2019 Amlogic, Inc. All rights reserved.
|
|
*/
|
|
|
|
#include <linux/io.h>
|
|
#include <linux/of_device.h>
|
|
#include <linux/pm_domain.h>
|
|
#include <linux/platform_device.h>
|
|
#include <linux/amlogic/power_domain.h>
|
|
#include <linux/pm_runtime.h>
|
|
|
|
static unsigned int power_domain;
|
|
struct generic_pm_domain **power_domains;
|
|
static unsigned int pdid_start, pdid_max;
|
|
|
|
int get_max_id(void)
|
|
{
|
|
return pdid_max;
|
|
}
|
|
|
|
static ssize_t power_on_store(struct device *dev,
|
|
struct device_attribute *attr,
|
|
const char *buf, size_t count)
|
|
{
|
|
int ret;
|
|
|
|
ret = kstrtouint(buf, 0, &power_domain);
|
|
if (ret)
|
|
return -EINVAL;
|
|
|
|
pwr_ctrl_psci_smc(power_domain, PWR_ON);
|
|
|
|
return count;
|
|
}
|
|
static DEVICE_ATTR_WO(power_on);
|
|
|
|
static ssize_t power_off_store(struct device *dev,
|
|
struct device_attribute *attr,
|
|
const char *buf, size_t count)
|
|
{
|
|
int ret;
|
|
|
|
ret = kstrtouint(buf, 0, &power_domain);
|
|
if (ret)
|
|
return -EINVAL;
|
|
|
|
pwr_ctrl_psci_smc(power_domain, PWR_OFF);
|
|
|
|
return count;
|
|
}
|
|
static DEVICE_ATTR_WO(power_off);
|
|
|
|
static ssize_t power_status_show(struct device *_dev,
|
|
struct device_attribute *attr, char *buf)
|
|
{
|
|
int power_status, i;
|
|
unsigned int len = 0, cnt = 30;
|
|
|
|
for (i = pdid_start; i < pdid_max; i++) {
|
|
if (!*(power_domains + i))
|
|
continue;
|
|
power_status = pwr_ctrl_status_psci_smc(i);
|
|
snprintf(buf, cnt, "%s[%d] :%d\n",
|
|
(*(power_domains + i))->name, i, power_status);
|
|
buf = buf + cnt;
|
|
len = len + cnt;
|
|
}
|
|
|
|
return len;
|
|
}
|
|
|
|
static ssize_t power_status_store(struct device *_dev,
|
|
struct device_attribute *attr,
|
|
const char *buf, size_t count)
|
|
{
|
|
int ret;
|
|
|
|
ret = kstrtouint(buf, 0, &power_domain);
|
|
if (ret)
|
|
return -EINVAL;
|
|
|
|
return count;
|
|
}
|
|
static DEVICE_ATTR_RW(power_status);
|
|
|
|
static ssize_t power_unused_show(struct device *_dev,
|
|
struct device_attribute *attr, char *buf)
|
|
{
|
|
int i;
|
|
|
|
for (i = 0 ; i < pdid_max ; i++) {
|
|
if (!power_domains[i] || power_domains[i]->flags & GENPD_FLAG_IGNORE_UNUSED)
|
|
continue;
|
|
|
|
queue_work(pm_wq, &power_domains[i]->power_off_work);
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
static DEVICE_ATTR_RO(power_unused);
|
|
|
|
void pd_dev_create_file(struct device *dev, int cnt_start, int cnt_end,
|
|
struct generic_pm_domain **domains)
|
|
{
|
|
power_domains = domains;
|
|
pdid_start = cnt_start;
|
|
pdid_max = cnt_end;
|
|
|
|
WARN_ON(device_create_file(dev, &dev_attr_power_status));
|
|
WARN_ON(device_create_file(dev, &dev_attr_power_on));
|
|
WARN_ON(device_create_file(dev, &dev_attr_power_off));
|
|
WARN_ON(device_create_file(dev, &dev_attr_power_unused));
|
|
}
|
|
|
|
void pd_dev_remove_file(struct device *dev)
|
|
{
|
|
device_remove_file(dev, &dev_attr_power_status);
|
|
device_remove_file(dev, &dev_attr_power_on);
|
|
device_remove_file(dev, &dev_attr_power_off);
|
|
device_remove_file(dev, &dev_attr_power_unused);
|
|
}
|