linuxOS_D21X/source/linux-5.10/drivers/video/artinchip/disp/aic_lvds.c

// SPDX-License-Identifier: GPL-2.0-only
/*
 * Copyright (C) 2020-2022 ArtInChip Technology Co., Ltd.
 * Authors:  Ning Fang <ning.fang@artinchip.com>
 */

#include <linux/module.h>
#include <linux/kernel.h>
#include <linux/platform_device.h>
#include <linux/errno.h>
#include <linux/string.h>
#include <linux/slab.h>
#include <linux/fb.h>
#include <linux/delay.h>
#include <linux/init.h>
#include <linux/ioport.h>
#include <linux/clk.h>
#include <linux/mutex.h>
#include <linux/component.h>
#include <linux/reset.h>
#include "hw/lvds_reg.h"
#include "hw/reg_util.h"
#include "aic_fb.h"

struct aic_lvds_comp {
	/* di_funcs must be the first member */
	struct di_funcs funcs;
	struct device *dev;
	void __iomem *regs;
	struct reset_control *reset;
	struct clk *mclk;
	struct clk *sclk;
	struct panel_lvds *lvds;
	ulong sclk_rate;
	u32 sync_ctrl;
	struct lvds_info info;
};
static struct aic_lvds_comp *g_aic_lvds_comp;

/*TODO: static function begin*/

static struct aic_lvds_comp *aic_lvds_request_drvdata(void)
{
	return g_aic_lvds_comp;
}

static void aic_lvds_release_drvdata(void)
{

}

static void lvds_0_lanes(struct aic_lvds_comp *comp, u32 value)
{
	reg_write(comp->regs + LVDS_0_SWAP, value);
}

static void lvds_1_lanes(struct aic_lvds_comp *comp, u32 value)
{
	reg_write(comp->regs + LVDS_1_SWAP, value);
}

static void lvds_0_pols(struct aic_lvds_comp *comp, u32 value)
{
	reg_write(comp->regs + LVDS_0_POL_CTL, value);
}

static void lvds_1_pols(struct aic_lvds_comp *comp, u32 value)
{
	reg_write(comp->regs + LVDS_1_POL_CTL, value);
}

static void lvds_phy_0_init(struct aic_lvds_comp *comp, u32 value)
{
	reg_write(comp->regs + LVDS_0_PHY_CTL, value);
}

static void lvds_phy_1_init(struct aic_lvds_comp *comp, u32 value)
{
	reg_write(comp->regs + LVDS_1_PHY_CTL, value);
}

static void lvds_link_swap(struct aic_lvds_comp *comp, u32 value)
{
	reg_set_bits(comp->regs + LVDS_CTL,
			 LVDS_CTL_SWAP_MASK,
			 LVDS_CTL_SWAP_EN(value));
}

static void lvds_mode(struct aic_lvds_comp *comp, u32 value)
{
	reg_set_bits(comp->regs + LVDS_CTL,
			 LVDS_CTL_MODE_MASK,
			 LVDS_CTL_MODE(value));
}

static void lvds_link_mode(struct aic_lvds_comp *comp, u32 value)
{
	reg_set_bits(comp->regs + LVDS_CTL,
			 LVDS_CTL_LINK_MASK,
			 LVDS_CTL_LINK(value));
}

static ssize_t
info_show(struct device *dev, struct device_attribute *devattr, char *buf)
{
	struct aic_lvds_comp *comp = aic_lvds_request_drvdata();
	struct lvds_info *info = &comp->info;
	int length;

	length = sprintf(buf, "LVDS INFO\n"
			"\tMode\t\t : %d \n"
			"\tLink Mode\t : %d \n"
			"\tLink Swap EN\t : %d\n"
			"\tLanes\t\t : 0x%05x 0x%05x\n"
			"\tPolarity\t : %#x %#x\n",
			comp->lvds->mode,
			comp->lvds->link_mode,
			info->link_swap,
			info->lanes[0],
			info->lanes[1],
			info->pols[0],
			info->pols[1]
			);

	aic_lvds_release_drvdata();
	return length;
}
static DEVICE_ATTR_RO(info);

static ssize_t
link_swap_store(struct device *dev, struct device_attribute *attr,
			 const char *buf, size_t count)
{
	struct aic_lvds_comp *comp = aic_lvds_request_drvdata();
	unsigned long val;
	int err;

	err = kstrtoul(buf, 0, &val);
	if (err)
		return err;

	comp->info.link_swap = val;
	lvds_link_swap(comp, val);

	aic_lvds_release_drvdata();
	return count;
}
static DEVICE_ATTR_WO(link_swap);

#define LVDS_LANE_CFG(field, prop, x)					\
static ssize_t								\
field##_store(struct device *dev, struct device_attribute *attr,	\
			 const char *buf, size_t count)			\
{									\
	struct aic_lvds_comp *comp = aic_lvds_request_drvdata();	\
	unsigned long val;						\
	int err;							\
									\
	err = kstrtoul(buf, 0, &val);					\
	if (err)							\
		return err;						\
									\
	comp->info.prop[x] = val;					\
	lvds_##x##_##prop(comp, val);					\
									\
	aic_lvds_release_drvdata();					\
	return count;							\
}									\
static DEVICE_ATTR_WO(field);						\

LVDS_LANE_CFG(link_0_pols, pols, 0);
LVDS_LANE_CFG(link_1_pols, pols, 1);
LVDS_LANE_CFG(link_0_lanes, lanes, 0);
LVDS_LANE_CFG(link_1_lanes, lanes, 1);

#define LVDS_CFG(field)							\
static ssize_t								\
field##_store(struct device *dev, struct device_attribute *attr,	\
			 const char *buf, size_t count)			\
{									\
	struct aic_lvds_comp *comp = aic_lvds_request_drvdata();	\
	unsigned long val;						\
	int err;							\
									\
	err = kstrtoul(buf, 0, &val);					\
	if (err)							\
		return err;						\
									\
	comp->lvds->field = val;					\
	lvds_##field(comp, val);					\
									\
	aic_lvds_release_drvdata();					\
	return count;							\
}									\
static DEVICE_ATTR_WO(field);						\

LVDS_CFG(mode);
LVDS_CFG(link_mode);

static struct attribute *aic_lvds_attrs[] = {
	&dev_attr_info.attr,
	&dev_attr_link_0_lanes.attr,
	&dev_attr_link_1_lanes.attr,
	&dev_attr_link_0_pols.attr,
	&dev_attr_link_1_pols.attr,
	&dev_attr_mode.attr,
	&dev_attr_link_mode.attr,
	&dev_attr_link_swap.attr,
	NULL
};

static const struct attribute_group aic_lvds_attr_group = {
	.attrs = aic_lvds_attrs,
	.name  = "debug",
};

static void
lvds_get_option_config(struct device_node *np, const char *name, u32 *data)
{
	int i, ret;

	for (i = 0; i < 2; i++) {
		ret = of_property_read_u32_index(np, name, i, data + i);
		if (ret)
			*(data + i) = 0x0;
	}
}

static int lvds_parse_dt(struct aic_lvds_comp *comp, struct device *dev)
{
	struct device_node *np = dev->of_node;

	/* enable lvds sync mode by default */
	if (of_property_read_u32(np, "sync-ctrl", &comp->sync_ctrl))
		comp->sync_ctrl = 1;

	if (of_property_read_u32(np, "link-swap", &comp->info.link_swap))
		comp->info.link_swap = 0;

	lvds_get_option_config(np, "pols", comp->info.pols);
	lvds_get_option_config(np, "lanes", comp->info.lanes);
	lvds_get_option_config(np, "pctrl", comp->info.phys);
	return 0;
}

static int lvds_clk_enable(void)
{
	struct aic_lvds_comp *comp = aic_lvds_request_drvdata();
	int ret = 0;

	if (comp->sclk_rate)
		clk_set_rate(comp->sclk, comp->sclk_rate);
	else
		dev_warn(comp->dev, "Use the default clock rate %ld\n",
			clk_get_rate(comp->sclk));

	ret = reset_control_deassert(comp->reset);
	if (ret) {
		dev_err(comp->dev, "Couldn't deassert\n");
		aic_lvds_release_drvdata();
		return ret;
	}

	ret = clk_prepare_enable(comp->mclk);
	if (ret) {
		dev_err(comp->dev, "Couldn't enable mclk\n");
		aic_lvds_release_drvdata();
		return ret;
	}

	aic_lvds_release_drvdata();
	return 0;
}

static int lvds_clk_disable(void)
{
	struct aic_lvds_comp *comp = aic_lvds_request_drvdata();

	clk_disable_unprepare(comp->mclk);
	reset_control_assert(comp->reset);
	aic_lvds_release_drvdata();
	return 0;
}

static void
lvds_set_mode(struct aic_lvds_comp *comp, struct panel_lvds *lvds)
{
	reg_set_bits(comp->regs + LVDS_CTL, LVDS_CTL_MODE_MASK,
			 LVDS_CTL_MODE(lvds->mode));
	reg_set_bits(comp->regs + LVDS_CTL, LVDS_CTL_LINK_MASK,
			 LVDS_CTL_LINK(lvds->link_mode));
}

static void
lvds_set_option_config(struct aic_lvds_comp *comp, struct panel_lvds *lvds)
{
	reg_set_bits(comp->regs + LVDS_CTL, LVDS_CTL_SYNC_MODE_MASK,
			 LVDS_CTL_SYNC_MODE_EN(comp->sync_ctrl));
	reg_set_bits(comp->regs + LVDS_CTL, LVDS_CTL_SWAP_MASK,
			 LVDS_CTL_SWAP_EN(comp->info.link_swap));

	lvds_0_lanes(comp, comp->info.lanes[0]);
	lvds_1_lanes(comp, comp->info.lanes[1]);

	lvds_0_pols(comp, comp->info.pols[0]);
	lvds_1_pols(comp, comp->info.pols[1]);

	lvds_phy_0_init(comp, comp->info.phys[0]);
	lvds_phy_1_init(comp, comp->info.phys[1]);
}

static int lvds_enable(void)
{
	struct aic_lvds_comp *comp = aic_lvds_request_drvdata();
	struct panel_lvds *lvds = comp->lvds;

	lvds_set_mode(comp, lvds);
	lvds_set_option_config(comp, lvds);

	reg_set_bit(comp->regs + LVDS_CTL, LVDS_CTL_EN);
	aic_lvds_release_drvdata();
	return 0;
}

static int lvds_disable(void)
{
	struct aic_lvds_comp *comp = aic_lvds_request_drvdata();

	reg_clr_bit(comp->regs + LVDS_CTL, LVDS_CTL_EN);
	aic_lvds_release_drvdata();
	return 0;
}

static int lvds_pixclk2mclk(ulong pixclk)
{
	s32 ret = 0;
	struct aic_lvds_comp *comp = aic_lvds_request_drvdata();
	struct panel_lvds *lvds = comp->lvds;

	dev_dbg(comp->dev, "Current pix-clk is %ld\n", pixclk);
	if (lvds->link_mode != DUAL_LINK)
		comp->sclk_rate = pixclk * 7;
	else
		comp->sclk_rate = pixclk * 3 + (pixclk >> 1); // * 3.5

	aic_lvds_release_drvdata();
	return ret;
}

static int lvds_attach_panel(struct aic_panel *panel)
{
	struct aic_lvds_comp *comp = aic_lvds_request_drvdata();

	comp->lvds = panel->lvds;
	return 0;
}

static int init_module_funcs(struct device *dev)
{
	struct aic_lvds_comp *comp = dev_get_drvdata(dev);

	comp->funcs.clk_enable = lvds_clk_enable;
	comp->funcs.clk_disable = lvds_clk_disable;
	comp->funcs.enable = lvds_enable;
	comp->funcs.disable = lvds_disable;
	comp->funcs.attach_panel = lvds_attach_panel;
	comp->funcs.pixclk2mclk = lvds_pixclk2mclk;
	return 0;
}

static int lvds_bind(struct device *dev, struct device *master,
		     void *data)
{
	struct platform_device *pdev = to_platform_device(dev);
	struct aic_lvds_comp *comp;
	struct resource *res;
	void __iomem *regs;
	int ret;

	comp = devm_kzalloc(dev, sizeof(*comp), GFP_KERNEL);
	if (!comp)
		return -ENOMEM;

	comp->dev = dev;
	dev_set_drvdata(dev, comp);
	g_aic_lvds_comp = comp;

	res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
	regs = devm_ioremap_resource(dev, res);
	if (IS_ERR(regs))
		return PTR_ERR(regs);

	comp->regs = regs;

	comp->mclk = devm_clk_get(dev, "lvds0");
	if (IS_ERR(comp->mclk)) {
		dev_err(dev, "Couldn't get lvds0 clock\n");
		return PTR_ERR(comp->mclk);
	}

	comp->sclk = devm_clk_get(dev, "sclk");
	if (IS_ERR(comp->sclk)) {
		dev_err(dev, "Couldn't get sclk clock\n");
		return PTR_ERR(comp->sclk);
	}

	comp->reset = devm_reset_control_get(dev, "lvds0");
	if (IS_ERR(comp->reset)) {
		dev_err(dev, "Couldn't get reset\n");
		return PTR_ERR(comp->reset);
	}

	ret = lvds_parse_dt(comp, dev);
	if (ret)
		return ret;

	ret = sysfs_create_group(&dev->kobj, &aic_lvds_attr_group);
	if (ret) {
		dev_err(dev, "Failed to create sysfs node.\n");
		return ret;
	}

	init_module_funcs(dev);
	return 0;
}

static void lvds_unbind(struct device *dev, struct device *master,
			void *data)
{
	sysfs_remove_group(&dev->kobj, &aic_lvds_attr_group);
}

static const struct component_ops lvds_com_ops = {
	.bind	= lvds_bind,
	.unbind	= lvds_unbind,
};

static int lvds_probe(struct platform_device *pdev)
{
	dev_dbg(&pdev->dev, "%s()\n", __func__);
	return component_add(&pdev->dev, &lvds_com_ops);
}

static int lvds_remove(struct platform_device *pdev)
{
	component_del(&pdev->dev, &lvds_com_ops);
	return 0;
}

static const struct of_device_id lvds_match_table[] = {
	{.compatible = "artinchip,aic-lvds-v1.0",},
	{},
};

MODULE_DEVICE_TABLE(of, lvds_match_table);

static struct platform_driver lvds_driver = {
	.probe = lvds_probe,
	.remove = lvds_remove,
	.driver = {
		.name = "disp lvds",
		.of_match_table	= lvds_match_table,
	},
};

module_platform_driver(lvds_driver);

MODULE_AUTHOR("Ning Fang <ning.fang@artinchip.com>");
MODULE_DESCRIPTION("AIC disp lvds driver");
MODULE_ALIAS("platform:lvds");
MODULE_LICENSE("GPL v2");