mirror of
https://github.com/hardkernel/linux.git
synced 2026-06-09 20:32:04 +09:00
add rk1000 tv out off
This commit is contained in:
林辉辉
@@ -128,5 +128,7 @@ source "drivers/staging/iio/Kconfig"
|
||||
source "drivers/staging/rk2818/rk2818_dsp/Kconfig"
|
||||
|
||||
source "drivers/staging/rk2818/rk1000_control/Kconfig"
|
||||
|
||||
source "drivers/staging/rk2818/rk1000_tv/Kconfig"
|
||||
endif # !STAGING_EXCLUDE_BUILD
|
||||
endif # STAGING
|
||||
|
||||
@@ -46,3 +46,4 @@ obj-$(CONFIG_DX_SEP) += sep/
|
||||
obj-$(CONFIG_IIO) += iio/
|
||||
obj-$(CONFIG_RK2818_DSP) += rk2818/rk2818_dsp/
|
||||
obj-$(CONFIG_RK1000_CONTROL) += rk2818/rk1000_control/
|
||||
obj-$(CONFIG_RK1000_TVOUT) += rk2818/rk1000_tv/
|
||||
|
||||
6
drivers/staging/rk2818/rk1000_tv/Kconfig
Executable file
6
drivers/staging/rk2818/rk1000_tv/Kconfig
Executable file
@@ -0,0 +1,6 @@
|
||||
menu "RK1000 TV CONTROL"
|
||||
config RK1000_TVOUT
|
||||
tristate "ROCKCHIP RK1000 TV CONTROL"
|
||||
depends on RK1000_CONTROL
|
||||
default n
|
||||
endmenu
|
||||
5
drivers/staging/rk2818/rk1000_tv/Makefile
Executable file
5
drivers/staging/rk2818/rk1000_tv/Makefile
Executable file
@@ -0,0 +1,5 @@
|
||||
#
|
||||
# Makefile for the RK1000 tv control.
|
||||
#
|
||||
|
||||
obj-$(CONFIG_RK1000_TVOUT) += rk1000_tv.o
|
||||
329
drivers/staging/rk2818/rk1000_tv/rk1000_tv.c
Executable file
329
drivers/staging/rk2818/rk1000_tv/rk1000_tv.c
Executable file
@@ -0,0 +1,329 @@
|
||||
/*
|
||||
* rk1000_tv.c
|
||||
*
|
||||
* Driver for rockchip rk1000 tv control
|
||||
* Copyright (C) 2009
|
||||
*
|
||||
* 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 <linux/module.h>
|
||||
#include <linux/device.h>
|
||||
#include <linux/i2c.h>
|
||||
#include <linux/delay.h>
|
||||
#include <linux/miscdevice.h>
|
||||
#include <linux/fcntl.h>
|
||||
#include <linux/fs.h>
|
||||
#include <linux/fb.h>
|
||||
#include <linux/console.h>
|
||||
#include <asm/uaccess.h>
|
||||
#include "rk1000_tv.h"
|
||||
|
||||
#define DRV_NAME "rk1000_tvout"
|
||||
|
||||
//#define DEBUG
|
||||
#ifdef DEBUG
|
||||
#define D(fmt, arg...) printk("<7>%s:%d: " fmt, __FILE__, __LINE__, ##arg)
|
||||
#else
|
||||
#define D(fmt, arg...)
|
||||
#endif
|
||||
#define E(fmt, arg...) printk("<3>!!!%s:%d: " fmt, __FILE__, __LINE__, ##arg)
|
||||
|
||||
|
||||
static volatile int rk1000_tv_output_status = RK28_LCD;
|
||||
|
||||
struct i2c_client *rk1000_tv_i2c_client = NULL;
|
||||
|
||||
|
||||
int rk1000_tv_control_set_reg(struct i2c_client *client, u8 reg, u8 const buf[], u8 len)
|
||||
{
|
||||
int ret;
|
||||
u8 i2c_buf[8];
|
||||
struct i2c_msg msgs[1] = {
|
||||
{ client->addr, 0, len + 1, i2c_buf }
|
||||
};
|
||||
|
||||
D("reg = 0x%.2X,value = 0x%.2X\n", reg, buf[0]);
|
||||
i2c_buf[0] = reg;
|
||||
memcpy(&i2c_buf[1], &buf[0], len);
|
||||
|
||||
ret = i2c_transfer(client->adapter, msgs, 1);
|
||||
if (ret > 0)
|
||||
ret = 0;
|
||||
|
||||
return ret;
|
||||
}
|
||||
#if 0
|
||||
int rk1000_tv_write_block(u8 addr, u8 *buf, u8 len)
|
||||
{
|
||||
int i;
|
||||
int ret = 0;
|
||||
|
||||
if(rk1000_tv_i2c_client == NULL){
|
||||
printk("<3>rk1000_tv_i2c_client not init!\n");
|
||||
return -1;
|
||||
}
|
||||
|
||||
for(i=0; i<len; i++){
|
||||
ret = rk1000_tv_control_set_reg(rk1000_tv_i2c_client, addr+i, buf+i, 1);
|
||||
if(ret != 0){
|
||||
printk("<3>rk1000_tv_control_set_reg err, addr=0x%.x, val=0x%.x", addr+i, buf[i]);
|
||||
break;
|
||||
}
|
||||
}
|
||||
|
||||
return ret;
|
||||
}
|
||||
EXPORT_SYMBOL(rk1000_tv_write_block);
|
||||
|
||||
/* drivers/video/rk28_fb.c */
|
||||
extern int win0fb_ioctl(struct fb_info *info, unsigned int cmd, unsigned long arg);
|
||||
extern int get_lcd_width(void);
|
||||
extern int get_lcd_height(void);
|
||||
|
||||
/* drivers/video/rk28_backlight.c */
|
||||
extern void rk28_bl_suspend(void *);
|
||||
extern void rk28_bl_resume(void *);
|
||||
|
||||
int rk28_tvout_win0fb_set_par(int x, int y, int w, int h)
|
||||
{
|
||||
int ret;
|
||||
struct fb_info *info = registered_fb[1]; // fb1
|
||||
struct fb_var_screeninfo var;
|
||||
|
||||
var = info->var;
|
||||
var.nonstd = ((y << 20) & 0xfff00000) +
|
||||
((x << 8 )& 0xfff00) + 3; //win0 ypos & xpos & format (ypos<<20 + xpos<<8 + format) // 2
|
||||
var.grayscale = ((h << 20) & 0xfff00000) +
|
||||
((w << 8) & 0xfff00) + 0; //win0 xsize & ysize;
|
||||
|
||||
acquire_console_sem();
|
||||
info->flags |= FBINFO_MISC_USEREVENT;
|
||||
ret = fb_set_var(info, &var);
|
||||
info->flags &= ~FBINFO_MISC_USEREVENT;
|
||||
release_console_sem();
|
||||
|
||||
if(ret < 0){
|
||||
E("fb_set_var err!\n");
|
||||
}
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
|
||||
int rk1000_tv_set_output(int type)
|
||||
{
|
||||
struct fb_info *info = registered_fb[1]; // fb1
|
||||
int ret = 0;
|
||||
|
||||
D("type = %d\n", type);
|
||||
|
||||
switch(type){
|
||||
case RK28_LCD:
|
||||
if(rk1000_tv_output_status == RK28_LCD){
|
||||
break;
|
||||
}
|
||||
rk1000_tv_output_status = RK28_LCD;
|
||||
win0fb_ioctl(info, 0x5001, 0);
|
||||
rk28_tvout_win0fb_set_par(0, 0, get_lcd_width(), get_lcd_height());
|
||||
rk28_bl_resume((void *)0);
|
||||
break;
|
||||
case Cvbs_NTSC:
|
||||
if(rk1000_tv_output_status == Cvbs_NTSC){
|
||||
break;
|
||||
}
|
||||
rk28_bl_suspend((void *)0);
|
||||
rk1000_tv_output_status = Cvbs_NTSC;
|
||||
win0fb_ioctl(info, 0x5001, 1);
|
||||
rk28_tvout_win0fb_set_par(0, 0, 720, 480);
|
||||
break;
|
||||
case Cvbs_PAL:
|
||||
if(rk1000_tv_output_status == Cvbs_PAL){
|
||||
break;
|
||||
}
|
||||
rk28_bl_suspend((void *)0);
|
||||
rk1000_tv_output_status = Cvbs_PAL;
|
||||
win0fb_ioctl(info, 0x5001, 2);
|
||||
rk28_tvout_win0fb_set_par(0, 0, 720, 576);
|
||||
break;
|
||||
case Ypbpr480:
|
||||
if(rk1000_tv_output_status == Ypbpr480){
|
||||
break;
|
||||
}
|
||||
rk28_bl_suspend((void *)0);
|
||||
rk1000_tv_output_status = Ypbpr480;
|
||||
win0fb_ioctl(info, 0x5001, 3);
|
||||
rk28_tvout_win0fb_set_par(0, 0, 720, 480);
|
||||
break;
|
||||
case Ypbpr576:
|
||||
if(rk1000_tv_output_status == Ypbpr576){
|
||||
break;
|
||||
}
|
||||
rk28_bl_suspend((void *)0);
|
||||
rk1000_tv_output_status = Ypbpr576;
|
||||
win0fb_ioctl(info, 0x5001, 4);
|
||||
rk28_tvout_win0fb_set_par(0, 0, 720, 576);
|
||||
break;
|
||||
case Ypbpr720:
|
||||
if(rk1000_tv_output_status == Ypbpr720){
|
||||
break;
|
||||
}
|
||||
rk28_bl_suspend((void *)0);
|
||||
rk1000_tv_output_status = Ypbpr720;
|
||||
win0fb_ioctl(info, 0x5001, 5);
|
||||
rk28_tvout_win0fb_set_par(0, 0, 1280, 720);
|
||||
break;
|
||||
default:
|
||||
ret = -EINVAL;
|
||||
E("Invalid type, type = %d\n", type);
|
||||
break;
|
||||
}
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
int rk1000_tv_get_output_status(void)
|
||||
{
|
||||
return rk1000_tv_output_status;
|
||||
}
|
||||
|
||||
int rk1000_tv_open(struct inode *inode, struct file *filp)
|
||||
{
|
||||
return 0;
|
||||
}
|
||||
|
||||
ssize_t rk1000_tv_write(struct file *filp, const char __user *buff, size_t count, loff_t *offp)
|
||||
{
|
||||
char c = 0;
|
||||
int ret;
|
||||
|
||||
ret = copy_from_user(&c, buff, 1);
|
||||
if(ret < 0){
|
||||
E("copy_from_user err!\n");
|
||||
return ret;
|
||||
}
|
||||
|
||||
rk1000_tv_set_output(c - '0');
|
||||
|
||||
return 1;
|
||||
}
|
||||
|
||||
int rk1000_tv_ioctl(struct inode *inode, struct file *filp, unsigned int cmd, unsigned long arg)
|
||||
{
|
||||
int ret = 0;
|
||||
|
||||
switch (cmd){
|
||||
case RK1000_TV_SET_OUTPUT:
|
||||
ret = rk1000_tv_set_output(arg);
|
||||
break;
|
||||
default:
|
||||
E("unknown ioctl cmd!\n");
|
||||
ret = -EINVAL;
|
||||
break;
|
||||
}
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
int rk1000_tv_release(struct inode *inode, struct file *filp)
|
||||
{
|
||||
return 0;
|
||||
}
|
||||
|
||||
static struct file_operations rk1000_tv_fops = {
|
||||
.owner = THIS_MODULE,
|
||||
.open = rk1000_tv_open,
|
||||
.write = rk1000_tv_write,
|
||||
.ioctl = rk1000_tv_ioctl,
|
||||
.release = rk1000_tv_release,
|
||||
};
|
||||
|
||||
struct miscdevice rk1000_tv_misc_dev = {
|
||||
.minor = MISC_DYNAMIC_MINOR,
|
||||
.name = DRV_NAME,
|
||||
.fops = &rk1000_tv_fops,
|
||||
};
|
||||
#endif
|
||||
static int rk1000_tv_control_remove(struct i2c_client *client)
|
||||
{
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int rk1000_tv_control_probe(struct i2c_client *client,const struct i2c_device_id *id)
|
||||
{
|
||||
int rc = 0;
|
||||
u8 buff;
|
||||
|
||||
if (!i2c_check_functionality(client->adapter, I2C_FUNC_I2C)) {
|
||||
rc = -ENODEV;
|
||||
goto failout;
|
||||
}
|
||||
|
||||
rk1000_tv_i2c_client = client;
|
||||
|
||||
//standby tv
|
||||
buff = 0x07;
|
||||
rk1000_tv_control_set_reg(client, 0x03, &buff, 1);
|
||||
printk("rk1000_tv_control probe ok\n");
|
||||
return 0;
|
||||
|
||||
failout:
|
||||
kfree(client);
|
||||
return rc;
|
||||
}
|
||||
|
||||
static const struct i2c_device_id rk1000_tv_control_id[] = {
|
||||
{ DRV_NAME, 0 },
|
||||
{ }
|
||||
};
|
||||
MODULE_DEVICE_TABLE(i2c, rk1000_control_id);
|
||||
|
||||
static struct i2c_driver rk1000_tv_control_driver = {
|
||||
.driver = {
|
||||
.name = DRV_NAME,
|
||||
},
|
||||
.id_table = rk1000_tv_control_id,
|
||||
.probe = rk1000_tv_control_probe,
|
||||
.remove = rk1000_tv_control_remove,
|
||||
};
|
||||
|
||||
static int __init rk1000_tv_init(void)
|
||||
{
|
||||
int ret;
|
||||
ret = i2c_add_driver(&rk1000_tv_control_driver);
|
||||
if(ret < 0){
|
||||
E("i2c_add_driver err, ret = %d\n", ret);
|
||||
goto err1;
|
||||
}
|
||||
|
||||
//ret = misc_register(&rk1000_tv_misc_dev);
|
||||
//if(ret < 0){
|
||||
// E("misc_register err, ret = %d\n", ret);
|
||||
// goto err2;
|
||||
//}
|
||||
|
||||
return 0;
|
||||
|
||||
err2:
|
||||
i2c_del_driver(&rk1000_tv_control_driver);
|
||||
err1:
|
||||
return ret;
|
||||
}
|
||||
|
||||
static void __exit rk1000_tv_exit(void)
|
||||
{
|
||||
//misc_deregister(&rk1000_tv_misc_dev);
|
||||
i2c_del_driver(&rk1000_tv_control_driver);
|
||||
}
|
||||
|
||||
module_init(rk1000_tv_init);
|
||||
module_exit(rk1000_tv_exit);
|
||||
/* Module information */
|
||||
MODULE_DESCRIPTION("ROCKCHIP rk1000 tv ");
|
||||
MODULE_LICENSE("GPL");
|
||||
|
||||
21
drivers/staging/rk2818/rk1000_tv/rk1000_tv.h
Executable file
21
drivers/staging/rk2818/rk1000_tv/rk1000_tv.h
Executable file
@@ -0,0 +1,21 @@
|
||||
#ifndef _RK1000_TV_H
|
||||
#define _RK1000_TV_H
|
||||
#include <linux/ioctl.h>
|
||||
|
||||
/******************* TVOUT ioctl CMD ************************/
|
||||
#define TVOUT_MAGIC 'T'
|
||||
|
||||
#define RK1000_TV_SET_OUTPUT _IOW(TVOUT_MAGIC, 1, int)
|
||||
|
||||
/******************* TVOUT OUTPUT TYPE **********************/
|
||||
#define RK28_LCD 0
|
||||
#define Cvbs_NTSC 1
|
||||
#define Cvbs_PAL 2
|
||||
#define Ypbpr480 3
|
||||
#define Ypbpr576 4
|
||||
#define Ypbpr720 5
|
||||
|
||||
int rk1000_tv_get_output_status(void);
|
||||
|
||||
#endif
|
||||
|
||||
Reference in New Issue
Block a user