diff options
Diffstat (limited to 'drivers/media/video/exynos/tv/hdmiphy_drv.c')
-rw-r--r-- | drivers/media/video/exynos/tv/hdmiphy_drv.c | 260 |
1 files changed, 260 insertions, 0 deletions
diff --git a/drivers/media/video/exynos/tv/hdmiphy_drv.c b/drivers/media/video/exynos/tv/hdmiphy_drv.c new file mode 100644 index 0000000..8cbb442 --- /dev/null +++ b/drivers/media/video/exynos/tv/hdmiphy_drv.c @@ -0,0 +1,260 @@ +/* + * Samsung HDMI Physical interface driver + * + * Copyright (C) 2010-2011 Samsung Electronics Co.Ltd + * Author: Tomasz Stanislawski <t.stanislaws@samsung.com> + * + * This program is free software; you can redistribute it and/or modify it + * under the terms of the GNU General Public License as published by the + * Free Software Foundation; either version 2 of the License, or (at your + * option) any later version. + */ +#include "hdmi.h" + +#include <linux/module.h> +#include <linux/i2c.h> +#include <linux/slab.h> +#include <linux/clk.h> +#include <linux/io.h> +#include <linux/interrupt.h> +#include <linux/irq.h> +#include <linux/err.h> + +#include <media/v4l2-subdev.h> + +MODULE_AUTHOR("Tomasz Stanislawski <t.stanislaws@samsung.com>"); +MODULE_DESCRIPTION("Samsung HDMI Physical interface driver"); +MODULE_LICENSE("GPL"); + +#ifdef DEBUG +static void hdmiphy_print_reg(u8 *recv_buffer) +{ + int i; + + for (i = 1; i <= 32; i++) { + printk("[%2x]", recv_buffer[i - 1]); + if (!(i % 8) && i) + printk("\n"); + } + printk("\n"); +} +#endif + +const u8 *hdmiphy_preset2conf(u32 preset) +{ + int i; + for (i = 0; i < hdmiphy_conf_cnt; ++i) + if (hdmiphy_conf[i].preset == preset) + return hdmiphy_conf[i].data; + return NULL; +} + +static int hdmiphy_ctrl(struct i2c_client *client, u8 reg, u8 bit, + u8 *recv_buffer, int en) +{ + int ret; + u8 buffer[2]; + struct device *dev = &client->dev; + + buffer[0] = reg; + buffer[1] = en ? (recv_buffer[reg] & (~(1 << bit))) : + (recv_buffer[reg] | (1 << bit)); + recv_buffer[reg] = buffer[1]; + + ret = i2c_master_send(client, buffer, 2); + if (ret != 2) { + dev_err(dev, "failed to turn %s HDMIPHY via I2C\n", + en ? "on" : "off"); + return -EIO; + } + + return 0; +} + +static int hdmiphy_enable_oscpad(struct i2c_client *client, int on, + u8 *recv_buffer) +{ + int ret; + u8 buffer[2]; + struct device *dev = &client->dev; + + buffer[0] = 0x0b; + if (on) + buffer[1] = 0xd8; + else + buffer[1] = 0x18; + recv_buffer[0x0b] = buffer[1]; + + ret = i2c_master_send(client, buffer, 2); + if (ret != 2) { + dev_err(dev, "failed to %s osc pad\n", + on ? "enable" : "disable"); + return -EIO; + } + + return 0; +} + +static int hdmiphy_s_power(struct v4l2_subdev *sd, int on) +{ + u8 recv_buffer[32]; + u8 buffer[2]; + struct i2c_client *client = v4l2_get_subdevdata(sd); + struct device *dev = &client->dev; + + memset(recv_buffer, 0, sizeof(recv_buffer)); + + dev_dbg(dev, "%s: hdmiphy is %s\n", __func__, on ? "on" : "off"); + + buffer[0] = 0x1; + i2c_master_send(client, buffer, 1); + i2c_master_recv(client, recv_buffer, 32); + +#ifdef DEBUG + hdmiphy_print_reg(recv_buffer); +#endif + + if (!on) + hdmiphy_enable_oscpad(client, 0, recv_buffer); + + hdmiphy_ctrl(client, 0x1d, 0x7, recv_buffer, on); + hdmiphy_ctrl(client, 0x1d, 0x0, recv_buffer, on); + hdmiphy_ctrl(client, 0x1d, 0x1, recv_buffer, on); + hdmiphy_ctrl(client, 0x1d, 0x2, recv_buffer, on); + hdmiphy_ctrl(client, 0x1d, 0x4, recv_buffer, on); + hdmiphy_ctrl(client, 0x1d, 0x5, recv_buffer, on); + hdmiphy_ctrl(client, 0x1d, 0x6, recv_buffer, on); + + if (!on) + hdmiphy_ctrl(client, 0x4, 0x3, recv_buffer, 0); + +#ifdef DEBUG + buffer[0] = 0x1; + i2c_master_send(client, buffer, 1); + i2c_master_recv(client, recv_buffer, 32); + + hdmiphy_print_reg(recv_buffer); +#endif + return 0; +} + +static int hdmiphy_s_dv_preset(struct v4l2_subdev *sd, + struct v4l2_dv_preset *preset) +{ + const u8 *data; + u8 buffer[32]; + u8 recv_buffer[32]; + int ret; + struct i2c_client *client = v4l2_get_subdevdata(sd); + struct device *dev = &client->dev; + + dev_dbg(dev, "s_dv_preset(preset = %d)\n", preset->preset); + data = hdmiphy_preset2conf(preset->preset); + if (!data) { + dev_err(dev, "format not supported\n"); + return -EINVAL; + } + + memset(recv_buffer, 0, 32); + +#ifdef DEBUG + i2c_master_recv(client, recv_buffer, 32); + hdmiphy_print_reg(recv_buffer); +#endif + + /* storing configuration to the device */ + memcpy(buffer, data, 32); + ret = i2c_master_send(client, buffer, 32); + if (ret != 32) { + dev_err(dev, "failed to configure HDMIPHY via I2C\n"); + return -EIO; + } + +#ifdef DEBUG + i2c_master_recv(client, recv_buffer, 32); + hdmiphy_print_reg(recv_buffer); +#endif + + return 0; +} + +static int hdmiphy_s_stream(struct v4l2_subdev *sd, int enable) +{ + struct i2c_client *client = v4l2_get_subdevdata(sd); + struct device *dev = &client->dev; + u8 buffer[2]; + int ret; + + dev_dbg(dev, "s_stream(%d)\n", enable); + /* going to/from configuration from/to operation mode */ + buffer[0] = 0x1f; + buffer[1] = enable ? 0x80 : 0x00; + + ret = i2c_master_send(client, buffer, 2); + if (ret != 2) { + dev_err(dev, "stream (%d) failed\n", enable); + return -EIO; + } + return 0; +} + +static const struct v4l2_subdev_core_ops hdmiphy_core_ops = { + .s_power = hdmiphy_s_power, +}; + +static const struct v4l2_subdev_video_ops hdmiphy_video_ops = { + .s_dv_preset = hdmiphy_s_dv_preset, + .s_stream = hdmiphy_s_stream, +}; + +static const struct v4l2_subdev_ops hdmiphy_ops = { + .core = &hdmiphy_core_ops, + .video = &hdmiphy_video_ops, +}; + +static int __devinit hdmiphy_probe(struct i2c_client *client, + const struct i2c_device_id *id) +{ + static struct v4l2_subdev sd; + + printk("hdmiphy_probe start\n"); + + v4l2_i2c_subdev_init(&sd, client, &hdmiphy_ops); + dev_info(&client->dev, "probe successful\n"); + return 0; +} + +static int __devexit hdmiphy_remove(struct i2c_client *client) +{ + dev_info(&client->dev, "remove successful\n"); + return 0; +} + +static const struct i2c_device_id hdmiphy_id[] = { + { "hdmiphy", 0 }, + { }, +}; +MODULE_DEVICE_TABLE(i2c, hdmiphy_id); + +static struct i2c_driver hdmiphy_driver = { + .driver = { + .name = "s5p-hdmiphy", + .owner = THIS_MODULE, + }, + .probe = hdmiphy_probe, + .remove = __devexit_p(hdmiphy_remove), + .id_table = hdmiphy_id, +}; + +static int __init hdmiphy_init(void) +{ + printk("hdmiphy init start\n"); + return i2c_add_driver(&hdmiphy_driver); +} +module_init(hdmiphy_init); + +static void __exit hdmiphy_exit(void) +{ + i2c_del_driver(&hdmiphy_driver); +} +module_exit(hdmiphy_exit); |