add mfd rk616

This commit is contained in:
yxj
2013-04-03 18:08:40 +08:00
parent aa275aaeb9
commit ed0e765a54
7 changed files with 418 additions and 0 deletions

View File

@@ -831,6 +831,15 @@ config MFD_RK610
help
if you say yes here you get support for the RK610, with func as
HDMI LCD LVDS TVOUT CODEC.
config MFD_RK616
bool "RK616(Jetta B) Multifunction device support"
depends on I2C=y
select MFD_CORE
help
if you say yes here you get support for the RK616, with func as
HDMI、LCD、LVDS、CODEC、MIPI.
endif # MFD_SUPPORT
menu "Multimedia Capabilities Port drivers"

View File

@@ -109,3 +109,4 @@ obj-$(CONFIG_MFD_TPS65910) += tps65910.o tps65910-irq.o
obj-$(CONFIG_TPS65911_COMPARATOR) += tps65911-comparator.o
obj-$(CONFIG_MFD_RK610) += rk610-core.o
obj-$(CONFIG_MFD_RK808) += rk808.o rk808-irq.o
obj-$(CONFIG_MFD_RK616) += rk616-core.o

159
drivers/mfd/rk616-core.c Normal file
View File

@@ -0,0 +1,159 @@
#include <linux/kernel.h>
#include <linux/module.h>
#include <linux/delay.h>
#include <linux/mfd/core.h>
#include <linux/slab.h>
#include <linux/irq.h>
#include <linux/mfd/rk616.h>
static struct mfd_cell rk616_devs[] = {
{
.name = "rk616-lvds",
.id = 0,
},
{
.name = "rk616-codec",
.id = 1,
},
{
.name = "rk616-hdmi",
.id = 2,
},
{
.name = "rk616-mipi",
.id = 3,
},
};
static int rk616_i2c_read_reg(struct mfd_rk616 *rk616, u16 reg,u32 *pval)
{
struct i2c_client * client = rk616->client;
struct i2c_adapter *adap = client->adapter;
struct i2c_msg msgs[2];
int ret;
char reg_buf[2];
memcpy(reg_buf, &reg, 2);
msgs[0].addr = client->addr;
msgs[0].flags = client->flags;
msgs[0].len = 2;
msgs[0].buf = reg_buf;
msgs[0].scl_rate = rk616->pdata->scl_rate;
msgs[0].udelay = client->udelay;
msgs[1].addr = client->addr;
msgs[1].flags = client->flags | I2C_M_RD;
msgs[1].len = 4;
msgs[1].buf = (char *)pval;
msgs[1].scl_rate = rk616->pdata->scl_rate;
msgs[1].udelay = client->udelay;
ret = i2c_transfer(adap, msgs, 2);
return (ret == 2)? 4 : ret;
}
static int rk616_i2c_write_reg(struct mfd_rk616 *rk616, u16 reg,u32 *pval)
{
struct i2c_client *client = rk616->client;
struct i2c_adapter *adap = client->adapter;
struct i2c_msg msg;
int ret;
char *tx_buf = (char *)kmalloc(6, GFP_KERNEL);
if(!tx_buf)
return -ENOMEM;
memcpy(tx_buf, &reg, 2);
memcpy(tx_buf+2, (char *)pval, 4);
msg.addr = client->addr;
msg.flags = client->flags;
msg.len = 6;
msg.buf = (char *)tx_buf;
msg.scl_rate = rk616->pdata->scl_rate;
msg.udelay = client->udelay;
ret = i2c_transfer(adap, &msg, 1);
kfree(tx_buf);
return (ret == 1) ? 4 : ret;
}
static int rk616_i2c_probe(struct i2c_client *client,const struct i2c_device_id *id)
{
int ret;
struct mfd_rk616 *rk616 = NULL;
if (!i2c_check_functionality(client->adapter, I2C_FUNC_I2C))
{
dev_err(&client->dev, "Must have I2C_FUNC_I2C.\n");
ret = -ENODEV;
}
rk616 = kzalloc(sizeof(struct mfd_rk616), GFP_KERNEL);
if (rk616 == NULL)
{
printk(KERN_ALERT "alloc for struct rk616 fail\n");
ret = -ENOMEM;
}
rk616->dev = &client->dev;
rk616->pdata = client->dev.platform_data;
rk616->client = client;
i2c_set_clientdata(client, rk616);
dev_set_drvdata(rk616->dev,rk616);
if(rk616->pdata->power_init)
rk616->pdata->power_init();
rk616->read_dev = rk616_i2c_read_reg;
rk616->write_dev = rk616_i2c_write_reg;
ret = mfd_add_devices(rk616->dev, -1,
rk616_devs, ARRAY_SIZE(rk616_devs),
NULL, rk616->irq_base);
printk("%s.........\n",__func__);
return 0;
}
static int __devexit rk616_i2c_remove(struct i2c_client *client)
{
return 0;
}
static const struct i2c_device_id id_table[] = {
{"rk616", 0 },
{ }
};
static struct i2c_driver rk616_i2c_driver = {
.driver = {
.name = "rk616",
.owner = THIS_MODULE,
},
.probe = &rk616_i2c_probe,
.remove = &rk616_i2c_remove,
.id_table = id_table,
};
static int __init rk616_module_init(void)
{
return i2c_add_driver(&rk616_i2c_driver);
}
static void __exit rk616_module_exit(void)
{
i2c_del_driver(&rk616_i2c_driver);
}
subsys_initcall_sync(rk616_module_init);
module_exit(rk616_module_exit);

View File

@@ -10,6 +10,12 @@ config RK610_LVDS
depends on MFD_RK610
help
Support Jetta(RK610) to output LCD1 and LVDS.
config RK616_LVDS
bool "RK616(Jetta B) lvds,lcd,scaler transmitter support"
depends on MFD_RK616
help
RK616(Jetta B) LVDS,LCD,scaler transmitter support.
config DP_ANX6345

View File

@@ -2,6 +2,7 @@
# Makefile for display transmitter like lvds edp mipi
#
obj-$(CONFIG_RK610_LVDS) += rk610_lcd.o
obj-$(CONFIG_RK616_LVDS) += rk616_lvds.o
obj-$(CONFIG_TC358768_RGB2MIPI) += mipi_dsi.o tc358768.o
obj-$(CONFIG_SSD2828_RGB2MIPI) += mipi_dsi.o ssd2828.o
obj-$(CONFIG_DP_ANX6345) += dp_anx6345.o

View File

@@ -0,0 +1,157 @@
#include <linux/kernel.h>
#include <linux/init.h>
#include <linux/platform_device.h>
#include <linux/slab.h>
#include <linux/mfd/rk616.h>
#include <linux/rk_fb.h>
struct mfd_rk616 *g_rk616;
/*rk616 video interface config*/
static int rk616_vif_cfg(struct mfd_rk616 *rk616,rk_screen *screen,int id)
{
int ret = 0;
u32 val = 0;
int offset = 0;
if(id == 0) //video interface 0
{
offset = 0;
}
else //vide0 interface 1
{
offset = 0x18;
}
val &= ((~VIF0_DDR_CLK_EN) & (~VIF0_DDR_PHASEN_EN) & (~VIF0_DDR_MODE_EN))|
(VIF0_EN);
val |= (VIF0_DDR_CLK_EN <<16) | (VIF0_DDR_PHASEN_EN << 16) | (VIF0_DDR_MODE_EN << 16)|
(VIF0_EN <<16);
ret = rk616->write_dev(rk616,VIF0_REG0 + offset,&val);
val = (screen->hsync_len + screen->left_margin) | ((screen->vsync_len + screen->upper_margin)<<16);
ret = rk616->write_dev(rk616,VIF0_REG1 + offset,&val);
val = (screen->hsync_len << 16) | (screen->hsync_len + screen->left_margin +
screen->right_margin + screen->x_res);
ret = rk616->write_dev(rk616,VIF0_REG2 + offset,&val);
val = ((screen->hsync_len + screen->left_margin + screen->x_res)<<16) |
(screen->hsync_len + screen->left_margin);
ret = rk616->write_dev(rk616,VIF0_REG3 + offset,&val);
val = (screen->vsync_len << 16) | (screen->vsync_len + screen->upper_margin +
screen->lower_margin + screen->y_res);
ret = rk616->write_dev(rk616,VIF0_REG4 + offset,&val);
val = ((screen->vsync_len + screen->upper_margin + screen->y_res)<<16) |
(screen->vsync_len + screen->upper_margin);
ret = rk616->write_dev(rk616,VIF0_REG5 + offset,&val);
return ret;
}
static int rk616_vif_bypass(struct mfd_rk616 *rk616,int id)
{
int ret;
u32 val = 0;
val &= (~VIF0_EN);
val |= (VIF0_EN << 16);
if(id == 0)
{
ret = rk616->write_dev(rk616,VIF0_REG0,&val);
}
else
{
ret = rk616->write_dev(rk616,VIF1_REG0,&val);
}
return ret;
}
static int rk616_scaler_bypass(struct mfd_rk616 *rk616)
{
u32 val = 0;
int ret;
val &= (~SCL_EN); //disable scaler
val |= (SCL_EN<<16);
ret = rk616->write_dev(rk616,SCL_REG0,&val);
return 0;
}
int rk610_lcd_scaler_set_param(rk_screen *screen,bool enable )//enable:0 bypass 1: scale
{
int ret;
struct mfd_rk616 *rk616 = g_rk616;
if(!rk616)
{
printk(KERN_ERR "%s:mfd rk616 is null!\n",__func__);
return -1;
}
rk616_vif_bypass(rk616,0);
rk616_vif_bypass(rk616,1);
rk616_scaler_bypass(rk616);
return ret;
}
static int rk616_lvds_probe(struct platform_device *pdev)
{
struct mfd_rk616 *rk616 = dev_get_drvdata(pdev->dev.parent);
if(!rk616)
{
dev_err(&pdev->dev,"null mfd device rk616!\n");
return -ENODEV;
}
else
g_rk616 = rk616;
dev_info(&pdev->dev,"rk616 lvds probe success!\n");
return 0;
}
static int rk616_lvds_remove(struct platform_device *pdev)
{
return 0;
}
static void rk616_lvds_shutdown(struct platform_device *pdev)
{
return;
}
static struct platform_driver rk616_lvds_driver = {
.driver = {
.name = "rk616-lvds",
.owner = THIS_MODULE,
},
.probe = rk616_lvds_probe,
.remove = rk616_lvds_remove,
.shutdown = rk616_lvds_shutdown,
};
static int __init rk616_lvds_init(void)
{
return platform_driver_register(&rk616_lvds_driver);
}
subsys_initcall_sync(rk616_lvds_init);
static void __exit rk616_lvds_exit(void)
{
platform_driver_unregister(&rk616_lvds_driver);
}
module_exit(rk616_lvds_exit);

85
include/linux/mfd/rk616.h Normal file
View File

@@ -0,0 +1,85 @@
#ifndef _RK616_H_
#define _RK616_H_
#include <linux/types.h>
#include <linux/i2c.h>
#define VIF0_REG0 0x0000
#define VIF0_DDR_CLK_EN (1<<3)
#define VIF0_DDR_PHASEN_EN (1<<2) //negative edge first en
#define VIF0_DDR_MODE_EN (1<<1)
#define VIF0_EN (1<<0)
#define VIF0_REG1 0x0004
#define VIF0_REG2 0x0008
#define VIF0_REG3 0x000C
#define VIF0_REG4 0x0010
#define VIF0_REG5 0x0014
#define VIF1_REG0 0x0018
#define VIF1_REG1 0x001C
#define VIF1_REG2 0x0020
#define VIF1_REG3 0x0024
#define VIF1_REG4 0x0028
#define VIF1_REG5 0x002C
#define SCL_REG0 0x0030
#define SCL_EN (1<<0)
#define SCL_REG1 0x0034
#define SCL_REG2 0x0038
#define SCL_REG3 0x003C
#define SCL_REG4 0x0040
#define SCL_REG5 0x0044
#define SCL_REG6 0x0048
#define SCL_REG7 0x004C
#define SCL_REG8 0x0050
#define FRC_REG 0x0054
#define CRU_CLKSEL0_CON 0x0058
#define CRU_CLKSEL1_CON 0x005C
#define CRU_CODEC_DIV 0x0060
#define CRU_CLKSE2_CON 0x0064
#define CRU_PLL0_CON0 0x0068
#define CRU_PLL0_CON1 0x006C
#define CRU_PLL0_CON2 0x0070
#define CRU_PLL1_CON0 0x0074
#define CRU_PLL1_CON1 0x0078
#define CRU_PLL1_CON2 0x007C
#define CRU_I2C_CON0 0x0080
#define CRU_LVDS_CON0 0x0084
#define CRU_IO_CON0 0x0088
#define CRU_IO_CON1 0x008C
#define CRU_PCM2IS2_CON0 0x0090
#define CRU_PCM2IS2_CON1 0x0094
#define CRU_PCM2IS2_CON2 0x0098
#define CRU_CFGMISC_CON 0x009C
struct rk616_platform_data {
int (*power_init)(void);
int scl_rate;
};
struct mfd_rk616 {
struct mutex reg_lock;
struct device *dev;
unsigned int irq_base;
struct rk616_platform_data *pdata;
struct i2c_client *client;
int (*read_dev)(struct mfd_rk616 *rk616, u16 reg,u32 *pval);
int (*write_dev)(struct mfd_rk616 *rk616,u16 reg,u32 *pval);
};
#endif