shinys000114/linux
1
0
Fork 0
mirror of https://github.com/hardkernel/linux.git synced 2026-06-08 03:40:35 +09:00
Code Issues Packages Projects Releases Wiki Activity

vout: add vpu_clkc clktree management function for display2

Browse Source 
PD#156734: vout: add vpu_clkc clktree management function for display2

Change-Id: I71f6d73cff9d7df2d7c8507f5f37b9d6d583286d
Signed-off-by: Evoke Zhang <evoke.zhang@amlogic.com>
This commit is contained in:
Evoke Zhang
2018-03-09 14:54:30 +08:00
committed by Jianxin Pan
parent 8ab003704b
commit b6bd5da274
2 changed files with 117 additions and 0 deletions
Download Patch File Download Diff File Expand all files Collapse all files

4
arch/arm64/boot/dts/amlogic/mesong12a.dtsi
View File

@@ -1071,6 +1071,10 @@
compatible = "amlogic, vout2";
dev_name = "vout";
status = "okay";
clocks = <&clkc CLKID_VPU_CLKC_P0_COMP>,
<&clkc CLKID_VPU_CLKC_MUX>;
clock-names = "vpu_clkc0",
"vpu_clkc";
};
vdac {

113
drivers/amlogic/media/vout/vout_serve/vout2_serve.c
View File

@@ -35,6 +35,8 @@
#include <linux/uaccess.h>
#include <linux/extcon.h>
#include <linux/cdev.h>
#include <linux/clk.h>
#include <linux/clk-provider.h>
/* Amlogic Headers */
#include <linux/amlogic/media/vout/vout_notify.h>
@@ -67,6 +69,8 @@ static const unsigned int vout2_cable[] = {
};
static struct vout_cdev_s *vout2_cdev;
static struct clk *vpu_clkc;
static unsigned char vpu_clkc_state;
/* **********************************************************
* null display support
@@ -720,6 +724,111 @@ static void aml_vout2_extcon_free(void)
** vout driver interface
**
******************************************************************/
static int vout2_clk_on_notifier(struct notifier_block *nb,
unsigned long event, void *data)
{
int *vmod;
if ((event & VOUT_EVENT_MODE_CHANGE_PRE) == 0)
return NOTIFY_DONE;
if (data == NULL) {
VOUTERR("%s: data is NULL\n", __func__);
return NOTIFY_DONE;
}
vmod = (int *)data;
if (*vmod < VMODE_NULL) {
if (IS_ERR_OR_NULL(vpu_clkc))
VOUTERR("vout2: vpu_clkc\n");
else {
if (vpu_clkc_state == 0) {
VOUTPR("vout2: enable vpu_clkc\n");
clk_prepare_enable(vpu_clkc);
vpu_clkc_state = 1;
}
}
}
return NOTIFY_OK;
}
static struct notifier_block vout2_clk_on_nb = {
.notifier_call = vout2_clk_on_notifier,
};
static int vout2_clk_off_notifier(struct notifier_block *nb,
unsigned long event, void *data)
{
int *vmod;
if ((event & VOUT_EVENT_MODE_CHANGE) == 0)
return NOTIFY_DONE;
if (data == NULL) {
VOUTERR("%s: data is NULL\n", __func__);
return NOTIFY_DONE;
}
vmod = (int *)data;
if (*vmod >= VMODE_NULL) {
if (IS_ERR_OR_NULL(vpu_clkc))
VOUTERR("vout2: vpu_clkc\n");
else {
if (vpu_clkc_state) {
VOUTPR("vout2: disable vpu_clkc\n");
clk_disable_unprepare(vpu_clkc);
vpu_clkc_state = 0;
}
}
}
return NOTIFY_OK;
}
static struct notifier_block vout2_clk_off_nb = {
.notifier_call = vout2_clk_off_notifier,
};
static int vout2_notifier_register(void)
{
int ret = 0;
ret = vout2_register_client(&vout2_clk_on_nb);
if (ret)
VOUTERR("register vout2_clk_on_nb failed\n");
ret = vout2_register_client(&vout2_clk_off_nb);
if (ret)
VOUTERR("register vout2_clk_off_nb failed\n");
return 0;
}
static void vout2_notifier_unregister(void)
{
vout2_unregister_client(&vout2_clk_on_nb);
vout2_unregister_client(&vout2_clk_off_nb);
}
static void vout2_clktree_init(struct device *dev)
{
struct clk *vpu_clkc0;
vpu_clkc = NULL;
vpu_clkc_state = 0;
/* init & enable vpu_clk */
vpu_clkc0 = devm_clk_get(dev, "vpu_clkc0");
vpu_clkc = devm_clk_get(dev, "vpu_clkc");
if ((IS_ERR_OR_NULL(vpu_clkc0)) ||
(IS_ERR_OR_NULL(vpu_clkc))) {
VOUTERR("vout2: %s: vpu_clkc\n", __func__);
} else {
clk_set_rate(vpu_clkc0, 200000000);
clk_set_parent(vpu_clkc, vpu_clkc0);
}
VOUTPR("vout2: clktree_init\n");
}
static int aml_vout2_probe(struct platform_device *pdev)
{
int ret = -1;
@@ -737,9 +846,12 @@ static int aml_vout2_probe(struct platform_device *pdev)
vout2_register_server(&nulldisp_vout2_server);
set_vout2_init_mode();
vout2_clktree_init(&pdev->dev);
aml_vout2_extcon_register(pdev);
vout2_notifier_register();
VOUTPR("vout2: %s OK\n", __func__);
return ret;
}
@@ -749,6 +861,7 @@ static int aml_vout2_remove(struct platform_device *pdev)
#ifdef CONFIG_AMLOGIC_LEGACY_EARLY_SUSPEND
unregister_early_suspend(&early_suspend);
#endif
vout2_notifier_unregister();
aml_vout2_extcon_free();
vout2_attr_remove();