[media] rename drivers/media/video as .../platform
The remaining drivers are mostly platform drivers. Name the dir to reflect it. It makes sense to latter break it into a few other dirs. Signed-off-by: Mauro Carvalho Chehab <mchehab@redhat.com>
This commit is contained in:
514
drivers/media/platform/davinci/vpif.c
Normal file
514
drivers/media/platform/davinci/vpif.c
Normal file
@@ -0,0 +1,514 @@
|
||||
/*
|
||||
* vpif - Video Port Interface driver
|
||||
* VPIF is a receiver and transmitter for video data. It has two channels(0, 1)
|
||||
* that receiveing video byte stream and two channels(2, 3) for video output.
|
||||
* The hardware supports SDTV, HDTV formats, raw data capture.
|
||||
* Currently, the driver supports NTSC and PAL standards.
|
||||
*
|
||||
* Copyright (C) 2009 Texas Instruments Incorporated - http://www.ti.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 version 2.
|
||||
*
|
||||
* This program is distributed .as is. WITHOUT ANY WARRANTY of any
|
||||
* kind, whether express or implied; without even the implied warranty
|
||||
* of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
||||
* GNU General Public License for more details.
|
||||
*/
|
||||
|
||||
#include <linux/init.h>
|
||||
#include <linux/module.h>
|
||||
#include <linux/platform_device.h>
|
||||
#include <linux/spinlock.h>
|
||||
#include <linux/kernel.h>
|
||||
#include <linux/io.h>
|
||||
#include <linux/clk.h>
|
||||
#include <linux/err.h>
|
||||
#include <mach/hardware.h>
|
||||
|
||||
#include "vpif.h"
|
||||
|
||||
MODULE_DESCRIPTION("TI DaVinci Video Port Interface driver");
|
||||
MODULE_LICENSE("GPL");
|
||||
|
||||
#define VPIF_CH0_MAX_MODES (22)
|
||||
#define VPIF_CH1_MAX_MODES (02)
|
||||
#define VPIF_CH2_MAX_MODES (15)
|
||||
#define VPIF_CH3_MAX_MODES (02)
|
||||
|
||||
static resource_size_t res_len;
|
||||
static struct resource *res;
|
||||
spinlock_t vpif_lock;
|
||||
|
||||
void __iomem *vpif_base;
|
||||
struct clk *vpif_clk;
|
||||
|
||||
/**
|
||||
* ch_params: video standard configuration parameters for vpif
|
||||
* The table must include all presets from supported subdevices.
|
||||
*/
|
||||
const struct vpif_channel_config_params ch_params[] = {
|
||||
/* HDTV formats */
|
||||
{
|
||||
.name = "480p59_94",
|
||||
.width = 720,
|
||||
.height = 480,
|
||||
.frm_fmt = 1,
|
||||
.ycmux_mode = 0,
|
||||
.eav2sav = 138-8,
|
||||
.sav2eav = 720,
|
||||
.l1 = 1,
|
||||
.l3 = 43,
|
||||
.l5 = 523,
|
||||
.vsize = 525,
|
||||
.capture_format = 0,
|
||||
.vbi_supported = 0,
|
||||
.hd_sd = 1,
|
||||
.dv_preset = V4L2_DV_480P59_94,
|
||||
},
|
||||
{
|
||||
.name = "576p50",
|
||||
.width = 720,
|
||||
.height = 576,
|
||||
.frm_fmt = 1,
|
||||
.ycmux_mode = 0,
|
||||
.eav2sav = 144-8,
|
||||
.sav2eav = 720,
|
||||
.l1 = 1,
|
||||
.l3 = 45,
|
||||
.l5 = 621,
|
||||
.vsize = 625,
|
||||
.capture_format = 0,
|
||||
.vbi_supported = 0,
|
||||
.hd_sd = 1,
|
||||
.dv_preset = V4L2_DV_576P50,
|
||||
},
|
||||
{
|
||||
.name = "720p50",
|
||||
.width = 1280,
|
||||
.height = 720,
|
||||
.frm_fmt = 1,
|
||||
.ycmux_mode = 0,
|
||||
.eav2sav = 700-8,
|
||||
.sav2eav = 1280,
|
||||
.l1 = 1,
|
||||
.l3 = 26,
|
||||
.l5 = 746,
|
||||
.vsize = 750,
|
||||
.capture_format = 0,
|
||||
.vbi_supported = 0,
|
||||
.hd_sd = 1,
|
||||
.dv_preset = V4L2_DV_720P50,
|
||||
},
|
||||
{
|
||||
.name = "720p60",
|
||||
.width = 1280,
|
||||
.height = 720,
|
||||
.frm_fmt = 1,
|
||||
.ycmux_mode = 0,
|
||||
.eav2sav = 370 - 8,
|
||||
.sav2eav = 1280,
|
||||
.l1 = 1,
|
||||
.l3 = 26,
|
||||
.l5 = 746,
|
||||
.vsize = 750,
|
||||
.capture_format = 0,
|
||||
.vbi_supported = 0,
|
||||
.hd_sd = 1,
|
||||
.dv_preset = V4L2_DV_720P60,
|
||||
},
|
||||
{
|
||||
.name = "1080I50",
|
||||
.width = 1920,
|
||||
.height = 1080,
|
||||
.frm_fmt = 0,
|
||||
.ycmux_mode = 0,
|
||||
.eav2sav = 720 - 8,
|
||||
.sav2eav = 1920,
|
||||
.l1 = 1,
|
||||
.l3 = 21,
|
||||
.l5 = 561,
|
||||
.l7 = 563,
|
||||
.l9 = 584,
|
||||
.l11 = 1124,
|
||||
.vsize = 1125,
|
||||
.capture_format = 0,
|
||||
.vbi_supported = 0,
|
||||
.hd_sd = 1,
|
||||
.dv_preset = V4L2_DV_1080I50,
|
||||
},
|
||||
{
|
||||
.name = "1080I60",
|
||||
.width = 1920,
|
||||
.height = 1080,
|
||||
.frm_fmt = 0,
|
||||
.ycmux_mode = 0,
|
||||
.eav2sav = 280 - 8,
|
||||
.sav2eav = 1920,
|
||||
.l1 = 1,
|
||||
.l3 = 21,
|
||||
.l5 = 561,
|
||||
.l7 = 563,
|
||||
.l9 = 584,
|
||||
.l11 = 1124,
|
||||
.vsize = 1125,
|
||||
.capture_format = 0,
|
||||
.vbi_supported = 0,
|
||||
.hd_sd = 1,
|
||||
.dv_preset = V4L2_DV_1080I60,
|
||||
},
|
||||
{
|
||||
.name = "1080p60",
|
||||
.width = 1920,
|
||||
.height = 1080,
|
||||
.frm_fmt = 1,
|
||||
.ycmux_mode = 0,
|
||||
.eav2sav = 280 - 8,
|
||||
.sav2eav = 1920,
|
||||
.l1 = 1,
|
||||
.l3 = 42,
|
||||
.l5 = 1122,
|
||||
.vsize = 1125,
|
||||
.capture_format = 0,
|
||||
.vbi_supported = 0,
|
||||
.hd_sd = 1,
|
||||
.dv_preset = V4L2_DV_1080P60,
|
||||
},
|
||||
|
||||
/* SDTV formats */
|
||||
{
|
||||
.name = "NTSC_M",
|
||||
.width = 720,
|
||||
.height = 480,
|
||||
.frm_fmt = 0,
|
||||
.ycmux_mode = 1,
|
||||
.eav2sav = 268,
|
||||
.sav2eav = 1440,
|
||||
.l1 = 1,
|
||||
.l3 = 23,
|
||||
.l5 = 263,
|
||||
.l7 = 266,
|
||||
.l9 = 286,
|
||||
.l11 = 525,
|
||||
.vsize = 525,
|
||||
.capture_format = 0,
|
||||
.vbi_supported = 1,
|
||||
.hd_sd = 0,
|
||||
.stdid = V4L2_STD_525_60,
|
||||
},
|
||||
{
|
||||
.name = "PAL_BDGHIK",
|
||||
.width = 720,
|
||||
.height = 576,
|
||||
.frm_fmt = 0,
|
||||
.ycmux_mode = 1,
|
||||
.eav2sav = 280,
|
||||
.sav2eav = 1440,
|
||||
.l1 = 1,
|
||||
.l3 = 23,
|
||||
.l5 = 311,
|
||||
.l7 = 313,
|
||||
.l9 = 336,
|
||||
.l11 = 624,
|
||||
.vsize = 625,
|
||||
.capture_format = 0,
|
||||
.vbi_supported = 1,
|
||||
.hd_sd = 0,
|
||||
.stdid = V4L2_STD_625_50,
|
||||
},
|
||||
};
|
||||
|
||||
const unsigned int vpif_ch_params_count = ARRAY_SIZE(ch_params);
|
||||
|
||||
static inline void vpif_wr_bit(u32 reg, u32 bit, u32 val)
|
||||
{
|
||||
if (val)
|
||||
vpif_set_bit(reg, bit);
|
||||
else
|
||||
vpif_clr_bit(reg, bit);
|
||||
}
|
||||
|
||||
/* This structure is used to keep track of VPIF size register's offsets */
|
||||
struct vpif_registers {
|
||||
u32 h_cfg, v_cfg_00, v_cfg_01, v_cfg_02, v_cfg, ch_ctrl;
|
||||
u32 line_offset, vanc0_strt, vanc0_size, vanc1_strt;
|
||||
u32 vanc1_size, width_mask, len_mask;
|
||||
u8 max_modes;
|
||||
};
|
||||
|
||||
static const struct vpif_registers vpifregs[VPIF_NUM_CHANNELS] = {
|
||||
/* Channel0 */
|
||||
{
|
||||
VPIF_CH0_H_CFG, VPIF_CH0_V_CFG_00, VPIF_CH0_V_CFG_01,
|
||||
VPIF_CH0_V_CFG_02, VPIF_CH0_V_CFG_03, VPIF_CH0_CTRL,
|
||||
VPIF_CH0_IMG_ADD_OFST, 0, 0, 0, 0, 0x1FFF, 0xFFF,
|
||||
VPIF_CH0_MAX_MODES,
|
||||
},
|
||||
/* Channel1 */
|
||||
{
|
||||
VPIF_CH1_H_CFG, VPIF_CH1_V_CFG_00, VPIF_CH1_V_CFG_01,
|
||||
VPIF_CH1_V_CFG_02, VPIF_CH1_V_CFG_03, VPIF_CH1_CTRL,
|
||||
VPIF_CH1_IMG_ADD_OFST, 0, 0, 0, 0, 0x1FFF, 0xFFF,
|
||||
VPIF_CH1_MAX_MODES,
|
||||
},
|
||||
/* Channel2 */
|
||||
{
|
||||
VPIF_CH2_H_CFG, VPIF_CH2_V_CFG_00, VPIF_CH2_V_CFG_01,
|
||||
VPIF_CH2_V_CFG_02, VPIF_CH2_V_CFG_03, VPIF_CH2_CTRL,
|
||||
VPIF_CH2_IMG_ADD_OFST, VPIF_CH2_VANC0_STRT, VPIF_CH2_VANC0_SIZE,
|
||||
VPIF_CH2_VANC1_STRT, VPIF_CH2_VANC1_SIZE, 0x7FF, 0x7FF,
|
||||
VPIF_CH2_MAX_MODES
|
||||
},
|
||||
/* Channel3 */
|
||||
{
|
||||
VPIF_CH3_H_CFG, VPIF_CH3_V_CFG_00, VPIF_CH3_V_CFG_01,
|
||||
VPIF_CH3_V_CFG_02, VPIF_CH3_V_CFG_03, VPIF_CH3_CTRL,
|
||||
VPIF_CH3_IMG_ADD_OFST, VPIF_CH3_VANC0_STRT, VPIF_CH3_VANC0_SIZE,
|
||||
VPIF_CH3_VANC1_STRT, VPIF_CH3_VANC1_SIZE, 0x7FF, 0x7FF,
|
||||
VPIF_CH3_MAX_MODES
|
||||
},
|
||||
};
|
||||
|
||||
/* vpif_set_mode_info:
|
||||
* This function is used to set horizontal and vertical config parameters
|
||||
* As per the standard in the channel, configure the values of L1, L3,
|
||||
* L5, L7 L9, L11 in VPIF Register , also write width and height
|
||||
*/
|
||||
static void vpif_set_mode_info(const struct vpif_channel_config_params *config,
|
||||
u8 channel_id, u8 config_channel_id)
|
||||
{
|
||||
u32 value;
|
||||
|
||||
value = (config->eav2sav & vpifregs[config_channel_id].width_mask);
|
||||
value <<= VPIF_CH_LEN_SHIFT;
|
||||
value |= (config->sav2eav & vpifregs[config_channel_id].width_mask);
|
||||
regw(value, vpifregs[channel_id].h_cfg);
|
||||
|
||||
value = (config->l1 & vpifregs[config_channel_id].len_mask);
|
||||
value <<= VPIF_CH_LEN_SHIFT;
|
||||
value |= (config->l3 & vpifregs[config_channel_id].len_mask);
|
||||
regw(value, vpifregs[channel_id].v_cfg_00);
|
||||
|
||||
value = (config->l5 & vpifregs[config_channel_id].len_mask);
|
||||
value <<= VPIF_CH_LEN_SHIFT;
|
||||
value |= (config->l7 & vpifregs[config_channel_id].len_mask);
|
||||
regw(value, vpifregs[channel_id].v_cfg_01);
|
||||
|
||||
value = (config->l9 & vpifregs[config_channel_id].len_mask);
|
||||
value <<= VPIF_CH_LEN_SHIFT;
|
||||
value |= (config->l11 & vpifregs[config_channel_id].len_mask);
|
||||
regw(value, vpifregs[channel_id].v_cfg_02);
|
||||
|
||||
value = (config->vsize & vpifregs[config_channel_id].len_mask);
|
||||
regw(value, vpifregs[channel_id].v_cfg);
|
||||
}
|
||||
|
||||
/* config_vpif_params
|
||||
* Function to set the parameters of a channel
|
||||
* Mainly modifies the channel ciontrol register
|
||||
* It sets frame format, yc mux mode
|
||||
*/
|
||||
static void config_vpif_params(struct vpif_params *vpifparams,
|
||||
u8 channel_id, u8 found)
|
||||
{
|
||||
const struct vpif_channel_config_params *config = &vpifparams->std_info;
|
||||
u32 value, ch_nip, reg;
|
||||
u8 start, end;
|
||||
int i;
|
||||
|
||||
start = channel_id;
|
||||
end = channel_id + found;
|
||||
|
||||
for (i = start; i < end; i++) {
|
||||
reg = vpifregs[i].ch_ctrl;
|
||||
if (channel_id < 2)
|
||||
ch_nip = VPIF_CAPTURE_CH_NIP;
|
||||
else
|
||||
ch_nip = VPIF_DISPLAY_CH_NIP;
|
||||
|
||||
vpif_wr_bit(reg, ch_nip, config->frm_fmt);
|
||||
vpif_wr_bit(reg, VPIF_CH_YC_MUX_BIT, config->ycmux_mode);
|
||||
vpif_wr_bit(reg, VPIF_CH_INPUT_FIELD_FRAME_BIT,
|
||||
vpifparams->video_params.storage_mode);
|
||||
|
||||
/* Set raster scanning SDR Format */
|
||||
vpif_clr_bit(reg, VPIF_CH_SDR_FMT_BIT);
|
||||
vpif_wr_bit(reg, VPIF_CH_DATA_MODE_BIT, config->capture_format);
|
||||
|
||||
if (channel_id > 1) /* Set the Pixel enable bit */
|
||||
vpif_set_bit(reg, VPIF_DISPLAY_PIX_EN_BIT);
|
||||
else if (config->capture_format) {
|
||||
/* Set the polarity of various pins */
|
||||
vpif_wr_bit(reg, VPIF_CH_FID_POLARITY_BIT,
|
||||
vpifparams->iface.fid_pol);
|
||||
vpif_wr_bit(reg, VPIF_CH_V_VALID_POLARITY_BIT,
|
||||
vpifparams->iface.vd_pol);
|
||||
vpif_wr_bit(reg, VPIF_CH_H_VALID_POLARITY_BIT,
|
||||
vpifparams->iface.hd_pol);
|
||||
|
||||
value = regr(reg);
|
||||
/* Set data width */
|
||||
value &= ~(0x3u <<
|
||||
VPIF_CH_DATA_WIDTH_BIT);
|
||||
value |= ((vpifparams->params.data_sz) <<
|
||||
VPIF_CH_DATA_WIDTH_BIT);
|
||||
regw(value, reg);
|
||||
}
|
||||
|
||||
/* Write the pitch in the driver */
|
||||
regw((vpifparams->video_params.hpitch),
|
||||
vpifregs[i].line_offset);
|
||||
}
|
||||
}
|
||||
|
||||
/* vpif_set_video_params
|
||||
* This function is used to set video parameters in VPIF register
|
||||
*/
|
||||
int vpif_set_video_params(struct vpif_params *vpifparams, u8 channel_id)
|
||||
{
|
||||
const struct vpif_channel_config_params *config = &vpifparams->std_info;
|
||||
int found = 1;
|
||||
|
||||
vpif_set_mode_info(config, channel_id, channel_id);
|
||||
if (!config->ycmux_mode) {
|
||||
/* YC are on separate channels (HDTV formats) */
|
||||
vpif_set_mode_info(config, channel_id + 1, channel_id);
|
||||
found = 2;
|
||||
}
|
||||
|
||||
config_vpif_params(vpifparams, channel_id, found);
|
||||
|
||||
regw(0x80, VPIF_REQ_SIZE);
|
||||
regw(0x01, VPIF_EMULATION_CTRL);
|
||||
|
||||
return found;
|
||||
}
|
||||
EXPORT_SYMBOL(vpif_set_video_params);
|
||||
|
||||
void vpif_set_vbi_display_params(struct vpif_vbi_params *vbiparams,
|
||||
u8 channel_id)
|
||||
{
|
||||
u32 value;
|
||||
|
||||
value = 0x3F8 & (vbiparams->hstart0);
|
||||
value |= 0x3FFFFFF & ((vbiparams->vstart0) << 16);
|
||||
regw(value, vpifregs[channel_id].vanc0_strt);
|
||||
|
||||
value = 0x3F8 & (vbiparams->hstart1);
|
||||
value |= 0x3FFFFFF & ((vbiparams->vstart1) << 16);
|
||||
regw(value, vpifregs[channel_id].vanc1_strt);
|
||||
|
||||
value = 0x3F8 & (vbiparams->hsize0);
|
||||
value |= 0x3FFFFFF & ((vbiparams->vsize0) << 16);
|
||||
regw(value, vpifregs[channel_id].vanc0_size);
|
||||
|
||||
value = 0x3F8 & (vbiparams->hsize1);
|
||||
value |= 0x3FFFFFF & ((vbiparams->vsize1) << 16);
|
||||
regw(value, vpifregs[channel_id].vanc1_size);
|
||||
|
||||
}
|
||||
EXPORT_SYMBOL(vpif_set_vbi_display_params);
|
||||
|
||||
int vpif_channel_getfid(u8 channel_id)
|
||||
{
|
||||
return (regr(vpifregs[channel_id].ch_ctrl) & VPIF_CH_FID_MASK)
|
||||
>> VPIF_CH_FID_SHIFT;
|
||||
}
|
||||
EXPORT_SYMBOL(vpif_channel_getfid);
|
||||
|
||||
static int __devinit vpif_probe(struct platform_device *pdev)
|
||||
{
|
||||
int status = 0;
|
||||
|
||||
res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
|
||||
if (!res)
|
||||
return -ENOENT;
|
||||
|
||||
res_len = resource_size(res);
|
||||
|
||||
res = request_mem_region(res->start, res_len, res->name);
|
||||
if (!res)
|
||||
return -EBUSY;
|
||||
|
||||
vpif_base = ioremap(res->start, res_len);
|
||||
if (!vpif_base) {
|
||||
status = -EBUSY;
|
||||
goto fail;
|
||||
}
|
||||
|
||||
vpif_clk = clk_get(&pdev->dev, "vpif");
|
||||
if (IS_ERR(vpif_clk)) {
|
||||
status = PTR_ERR(vpif_clk);
|
||||
goto clk_fail;
|
||||
}
|
||||
clk_enable(vpif_clk);
|
||||
|
||||
spin_lock_init(&vpif_lock);
|
||||
dev_info(&pdev->dev, "vpif probe success\n");
|
||||
return 0;
|
||||
|
||||
clk_fail:
|
||||
iounmap(vpif_base);
|
||||
fail:
|
||||
release_mem_region(res->start, res_len);
|
||||
return status;
|
||||
}
|
||||
|
||||
static int __devexit vpif_remove(struct platform_device *pdev)
|
||||
{
|
||||
if (vpif_clk) {
|
||||
clk_disable(vpif_clk);
|
||||
clk_put(vpif_clk);
|
||||
}
|
||||
|
||||
iounmap(vpif_base);
|
||||
release_mem_region(res->start, res_len);
|
||||
return 0;
|
||||
}
|
||||
|
||||
#ifdef CONFIG_PM
|
||||
static int vpif_suspend(struct device *dev)
|
||||
{
|
||||
clk_disable(vpif_clk);
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int vpif_resume(struct device *dev)
|
||||
{
|
||||
clk_enable(vpif_clk);
|
||||
return 0;
|
||||
}
|
||||
|
||||
static const struct dev_pm_ops vpif_pm = {
|
||||
.suspend = vpif_suspend,
|
||||
.resume = vpif_resume,
|
||||
};
|
||||
|
||||
#define vpif_pm_ops (&vpif_pm)
|
||||
#else
|
||||
#define vpif_pm_ops NULL
|
||||
#endif
|
||||
|
||||
static struct platform_driver vpif_driver = {
|
||||
.driver = {
|
||||
.name = "vpif",
|
||||
.owner = THIS_MODULE,
|
||||
.pm = vpif_pm_ops,
|
||||
},
|
||||
.remove = __devexit_p(vpif_remove),
|
||||
.probe = vpif_probe,
|
||||
};
|
||||
|
||||
static void vpif_exit(void)
|
||||
{
|
||||
platform_driver_unregister(&vpif_driver);
|
||||
}
|
||||
|
||||
static int __init vpif_init(void)
|
||||
{
|
||||
return platform_driver_register(&vpif_driver);
|
||||
}
|
||||
subsys_initcall(vpif_init);
|
||||
module_exit(vpif_exit);
|
||||
|
Reference in New Issue
Block a user