Commit d2867be8 authored by 邱宗炽's avatar 邱宗炽

ths8200 and FB driver code format adjust

Signed-off-by: default avatar邱宗炽 <tqiu@neuros.com.cn>
parent 00d2c3e5
...@@ -38,8 +38,7 @@ ...@@ -38,8 +38,7 @@
static int ths8200_attach_adapter(struct i2c_adapter *adapter); static int ths8200_attach_adapter(struct i2c_adapter *adapter);
static int ths8200_detach_client(struct i2c_client *client); static int ths8200_detach_client(struct i2c_client *client);
static int ths8200_detect_client(struct i2c_adapter *adapter, static int ths8200_detect_client(struct i2c_adapter *adapter, int address, int kind);
int address, int kind);
static inline int ths8200_write_value(u8 reg, u8 value); static inline int ths8200_write_value(u8 reg, u8 value);
static inline int ths8200_read_value(u8 reg); static inline int ths8200_read_value(u8 reg);
...@@ -56,8 +55,7 @@ static struct i2c_driver ths8200_driver = { ...@@ -56,8 +55,7 @@ static struct i2c_driver ths8200_driver = {
}; };
/* I2C Addresses to scan */ /* I2C Addresses to scan */
static unsigned short normal_i2c[] = { 0x20, \ static unsigned short normal_i2c[] = { 0x20, I2C_CLIENT_END };
I2C_CLIENT_END};
/* This makes all addr_data:s */ /* This makes all addr_data:s */
I2C_CLIENT_INSMOD; I2C_CLIENT_INSMOD;
...@@ -74,8 +72,7 @@ static inline int ths8200_write_value(u8 reg, u8 value) ...@@ -74,8 +72,7 @@ static inline int ths8200_write_value(u8 reg, u8 value)
{ {
int ret; int ret;
ret = i2c_smbus_write_byte_data(ths8200_client, ret = i2c_smbus_write_byte_data(ths8200_client, reg, value);
reg, value);
if (ret != 0) if (ret != 0)
DPRINTK("Write Error Address = %x\n", reg); DPRINTK("Write Error Address = %x\n", reg);
...@@ -100,8 +97,7 @@ static int ths8200_detach_client(struct i2c_client *client) ...@@ -100,8 +97,7 @@ static int ths8200_detach_client(struct i2c_client *client)
err = i2c_detach_client(client); err = i2c_detach_client(client);
if (err) { if (err) {
DPRINTK("Client deregistration failed, \ DPRINTK("Client deregistration failed, client not detached.\n");
client not detached.\n");
return err; return err;
} }
kfree(client); kfree(client);
...@@ -110,26 +106,24 @@ static int ths8200_detach_client(struct i2c_client *client) ...@@ -110,26 +106,24 @@ static int ths8200_detach_client(struct i2c_client *client)
} }
static int ths8200_detect_client(struct i2c_adapter *adapter, static int ths8200_detect_client(struct i2c_adapter *adapter,
int address, int kind) int address, int kind)
{ {
int err = 0; int err = 0;
const char *client_name = "THS8200 Video DAC"; const char *client_name = "THS8200 Video DAC";
FN_IN; FN_IN;
if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_WORD_DATA | if (!i2c_check_functionality(adapter,
I2C_FUNC_SMBUS_WORD_DATA |
I2C_FUNC_SMBUS_WRITE_BYTE)) { I2C_FUNC_SMBUS_WRITE_BYTE)) {
DPRINTK("Functinality check failed for %s \n", DPRINTK("Functinality check failed for %s \n", client_name);
client_name);
return err; return err;
} }
ths8200_client = kmalloc(sizeof(struct i2c_client), ths8200_client = kmalloc(sizeof(struct i2c_client), GFP_KERNEL);
GFP_KERNEL);
if (ths8200_client == NULL) { if (ths8200_client == NULL) {
err = -ENOMEM; err = -ENOMEM;
DPRINTK("Couldn't allocate memory for %s\n", DPRINTK("Couldn't allocate memory for %s\n", client_name);
client_name);
return err; return err;
} }
...@@ -152,14 +146,15 @@ static int ths8200_detect_client(struct i2c_adapter *adapter, ...@@ -152,14 +146,15 @@ static int ths8200_detect_client(struct i2c_adapter *adapter,
int ths8200_set_480p_mode(void) int ths8200_set_480p_mode(void)
{ {
/* place ths8200 in reset state */ /* place ths8200 in reset state */
ths8200_write_value(CHIP_CTL_REG, CHIP_SOFTWARE_RESET); ths8200_write_value(CHIP_CTL_REG, CHIP_SOFTWARE_RESET);
/* take ths8200 out of reset and in normal operation mode */ /* take ths8200 out of reset and in normal operation mode */
ths8200_write_value(CHIP_CTL_REG, CHIP_SOFTWARE_OUT_OF_RESET | ths8200_write_value(CHIP_CTL_REG,
CHIP_LOW_FREQUENCY); CHIP_SOFTWARE_OUT_OF_RESET |
CHIP_LOW_FREQUENCY);
/* place color space conversion control in reset state */ /* place color space conversion control in reset state */
ths8200_write_value(CSC_R11_REG, 0x00); ths8200_write_value(CSC_R11_REG, 0x00);
ths8200_write_value(CSC_R21_REG, 0x00); ths8200_write_value(CSC_R21_REG, 0x00);
ths8200_write_value(CSC_R31_REG, 0x00); ths8200_write_value(CSC_R31_REG, 0x00);
...@@ -173,14 +168,15 @@ int ths8200_set_480p_mode(void) ...@@ -173,14 +168,15 @@ int ths8200_set_480p_mode(void)
ths8200_write_value(CSC_OFFS12_REG, 0x00); ths8200_write_value(CSC_OFFS12_REG, 0x00);
ths8200_write_value(CSC_OFFS23_REG, 0x00); ths8200_write_value(CSC_OFFS23_REG, 0x00);
ths8200_write_value(CSC_OFFS3_REG, ths8200_write_value(CSC_OFFS3_REG,
CSC_BYPASSED | CSC_BYPASSED |
CSC_PROTECTION_ON); CSC_PROTECTION_ON);
/* set YCx20 External Sync */ /* set YCx20 External Sync */
ths8200_write_value(DTG2_CNTL_REG, HS_IN_POSITIVE_POLARITY | ths8200_write_value(DTG2_CNTL_REG,
VS_IN_POSITIVE_POLARITY | HS_IN_POSITIVE_POLARITY |
HS_OUT_POSITIVE_POLARITY | VS_IN_POSITIVE_POLARITY |
VS_OUT_POSITIVE_POLARITY); HS_OUT_POSITIVE_POLARITY |
VS_OUT_POSITIVE_POLARITY);
/* select the format for the input data manager */ /* select the format for the input data manager */
ths8200_write_value(DATA_CNTL_REG, DATA_20BIT_YCBCR_MODE); ths8200_write_value(DATA_CNTL_REG, DATA_20BIT_YCBCR_MODE);
...@@ -202,8 +198,8 @@ int ths8200_set_480p_mode(void) ...@@ -202,8 +198,8 @@ int ths8200_set_480p_mode(void)
ths8200_write_value(DTG1_CBCR_SYNC1_LSB_REG, 0xFF); ths8200_write_value(DTG1_CBCR_SYNC1_LSB_REG, 0xFF);
/* set the amplitude of the negative sync and /* set the amplitude of the negative sync and
equalization/serration/broad pulses for the equalization/serration/broad pulses for the
Cb and Cr channels */ Cb and Cr channels */
ths8200_write_value(DTG1_CBCR_SYNC2_LSB_REG, 0xFF); ths8200_write_value(DTG1_CBCR_SYNC2_LSB_REG, 0xFF);
/* set the amplitude of the positive sync for the Cb and Cr channels */ /* set the amplitude of the positive sync for the Cb and Cr channels */
...@@ -212,13 +208,13 @@ int ths8200_set_480p_mode(void) ...@@ -212,13 +208,13 @@ int ths8200_set_480p_mode(void)
/* set msb for sync1 sync2 and sync3 */ /* set msb for sync1 sync2 and sync3 */
ths8200_write_value(DTG1_CBCR_SYNC_MSB_REG, 0x15); ths8200_write_value(DTG1_CBCR_SYNC_MSB_REG, 0x15);
/* set negative hsync width (half of total width) */ /* set negative hsync width (half of total width) */
ths8200_write_value(DTG1_SPEC_A_REG, 0x28); ths8200_write_value(DTG1_SPEC_A_REG, 0x28);
/* set end of active video to start of negative sync */ /* set end of active video to start of negative sync */
ths8200_write_value(DTG1_SPEC_B_REG, 0x10); ths8200_write_value(DTG1_SPEC_B_REG, 0x10);
/* set positive hsync width (half of total width) */ /* set positive hsync width (half of total width) */
ths8200_write_value(DTG1_SPEC_C_REG, 0x28); ths8200_write_value(DTG1_SPEC_C_REG, 0x28);
/* set LSBs of sync to broad pulse */ /* set LSBs of sync to broad pulse */
...@@ -227,13 +223,13 @@ int ths8200_set_480p_mode(void) ...@@ -227,13 +223,13 @@ int ths8200_set_480p_mode(void)
/* set LSBs of sync to active video */ /* set LSBs of sync to active video */
ths8200_write_value(DTG1_SPEC_E_LSB_REG, 0x7A); ths8200_write_value(DTG1_SPEC_E_LSB_REG, 0x7A);
/* set MSB bit of sync to active video width[6]/sync to broad pulse [7] */ /* set MSB bit of sync to active video width[6]/sync to broad pulse [7] */
ths8200_write_value(DTG1_SPEC_DEH_MSB_REG, 0x00); ths8200_write_value(DTG1_SPEC_DEH_MSB_REG, 0x00);
/* set broad pulse duration for SDTV (NA) */ /* set broad pulse duration for SDTV (NA) */
ths8200_write_value(DTG1_SPEC_H_LSB_REG, 0x00); ths8200_write_value(DTG1_SPEC_H_LSB_REG, 0x00);
/* set end of active video to sync LSBs [7:0] */ /* set end of active video to sync LSBs [7:0] */
ths8200_write_value(DTG1_SPEC_K_LSB_REG, 0x10); ths8200_write_value(DTG1_SPEC_K_LSB_REG, 0x10);
/* set end of active video to sync MSBs [2:0] */ /* set end of active video to sync MSBs [2:0] */
...@@ -246,17 +242,17 @@ int ths8200_set_480p_mode(void) ...@@ -246,17 +242,17 @@ int ths8200_set_480p_mode(void)
ths8200_write_value(DTG1_TOTAL_PIXELS_LSB_REG, 0x5A); ths8200_write_value(DTG1_TOTAL_PIXELS_LSB_REG, 0x5A);
/* set MSB and LSB bit of the starting line number /* set MSB and LSB bit of the starting line number
for the DTG when Vsync input or V-bit is for the DTG when Vsync input or V-bit is
asserted(vertical display control) */ asserted(vertical display control) */
ths8200_write_value(DTG1_FIELDFLIP_LINECNT_MSB_REG, 0x00); ths8200_write_value(DTG1_FIELDFLIP_LINECNT_MSB_REG, 0x00);
ths8200_write_value(DTG1_FIELDFLIP_LINECNT_LSB_REG, 0x01); ths8200_write_value(DTG1_FIELDFLIP_LINECNT_LSB_REG, 0x01);
/* set DTG on and set DTG operation mode to /* set DTG on and set DTG operation mode to
ATSC mode 720P(SMPTE296M progressive)*/ ATSC mode 720P(SMPTE296M progressive)*/
ths8200_write_value(DTG1_MODE_REG, DTG_ON | ATSC_MODE_480P); ths8200_write_value(DTG1_MODE_REG, DTG_ON | ATSC_MODE_480P);
/* set MSB bit of number of lines per frame and /* set MSB bit of number of lines per frame and
number of lines in field 1when in generic mode */ number of lines in field 1when in generic mode */
ths8200_write_value(DTG1_FRAME_FILED_SIZE_MSB_REG, 0x27); ths8200_write_value(DTG1_FRAME_FILED_SIZE_MSB_REG, 0x27);
/* set LSB bit of number of lines per frame when in generic mode */ /* set LSB bit of number of lines per frame when in generic mode */
...@@ -266,25 +262,26 @@ int ths8200_set_480p_mode(void) ...@@ -266,25 +262,26 @@ int ths8200_set_480p_mode(void)
ths8200_write_value(DTG1_FIELDSIZE_LSB_REG, 0xFF); ths8200_write_value(DTG1_FIELDSIZE_LSB_REG, 0xFF);
/* set MSB and LSB bit of the number of pixels that the DTG /* set MSB and LSB bit of the number of pixels that the DTG
startup is horizontally delayed with respect to HS input for startup is horizontally delayed with respect to HS input for
dedicated timing modes or EAV input for embedded dedicated timing modes or EAV input for embedded
timing modes. */ timing modes. */
ths8200_write_value(DTG2_HS_IN_DLY_MSB_REG, 0x00); ths8200_write_value(DTG2_HS_IN_DLY_MSB_REG, 0x00);
ths8200_write_value(DTG2_HS_IN_DLY_LSB_REG, 0x40); ths8200_write_value(DTG2_HS_IN_DLY_LSB_REG, 0x40);
/* set MSB and LSB bit of the number of lines that the DTG /* set MSB and LSB bit of the number of lines that the DTG
startup is vertically delayed with respect to VS input for startup is vertically delayed with respect to VS input for
dedicated timing modes or the line counter value for dedicated timing modes or the line counter value for
embedded timing.*/ embedded timing.*/
ths8200_write_value(DTG2_VS_IN_DLY_MSB_REG, 0x00); ths8200_write_value(DTG2_VS_IN_DLY_MSB_REG, 0x00);
ths8200_write_value(DTG2_VS_IN_DLY_LSB_REG, 0x00); ths8200_write_value(DTG2_VS_IN_DLY_LSB_REG, 0x00);
/* place ths8200 in reset state */ /* place ths8200 in reset state */
ths8200_write_value(CHIP_CTL_REG, CHIP_SOFTWARE_RESET); ths8200_write_value(CHIP_CTL_REG, CHIP_SOFTWARE_RESET);
/* take ths8200 out of reset and in normal operation mode */ /* take ths8200 out of reset and in normal operation mode */
ths8200_write_value(CHIP_CTL_REG, CHIP_SOFTWARE_OUT_OF_RESET | ths8200_write_value(CHIP_CTL_REG,
CHIP_LOW_FREQUENCY); CHIP_SOFTWARE_OUT_OF_RESET |
CHIP_LOW_FREQUENCY);
printk(KERN_INFO "THS8200 set video mode as 480p\n"); printk(KERN_INFO "THS8200 set video mode as 480p\n");
...@@ -295,13 +292,13 @@ int ths8200_set_720p_mode(void) ...@@ -295,13 +292,13 @@ int ths8200_set_720p_mode(void)
{ {
FN_IN; FN_IN;
/* place ths8200 in reset state */ /* place ths8200 in reset state */
ths8200_write_value(CHIP_CTL_REG, CHIP_SOFTWARE_RESET); ths8200_write_value(CHIP_CTL_REG, CHIP_SOFTWARE_RESET);
/* take ths8200 out of reset and in normal operation mode */ /* take ths8200 out of reset and in normal operation mode */
ths8200_write_value(CHIP_CTL_REG, CHIP_SOFTWARE_OUT_OF_RESET); ths8200_write_value(CHIP_CTL_REG, CHIP_SOFTWARE_OUT_OF_RESET);
/* place color space conversion control in reset state */ /* place color space conversion control in reset state */
ths8200_write_value(CSC_R11_REG, 0x00); ths8200_write_value(CSC_R11_REG, 0x00);
ths8200_write_value(CSC_R21_REG, 0x00); ths8200_write_value(CSC_R21_REG, 0x00);
ths8200_write_value(CSC_R31_REG, 0x00); ths8200_write_value(CSC_R31_REG, 0x00);
...@@ -315,14 +312,15 @@ int ths8200_set_720p_mode(void) ...@@ -315,14 +312,15 @@ int ths8200_set_720p_mode(void)
ths8200_write_value(CSC_OFFS12_REG, 0x00); ths8200_write_value(CSC_OFFS12_REG, 0x00);
ths8200_write_value(CSC_OFFS23_REG, 0x00); ths8200_write_value(CSC_OFFS23_REG, 0x00);
ths8200_write_value(CSC_OFFS3_REG, ths8200_write_value(CSC_OFFS3_REG,
CSC_BYPASSED | CSC_BYPASSED |
CSC_PROTECTION_ON); CSC_PROTECTION_ON);
/* set YCx20 External Sync */ /* set YCx20 External Sync */
ths8200_write_value(DTG2_CNTL_REG, HS_IN_POSITIVE_POLARITY | ths8200_write_value(DTG2_CNTL_REG,
VS_IN_POSITIVE_POLARITY | HS_IN_POSITIVE_POLARITY |
HS_OUT_POSITIVE_POLARITY | VS_IN_POSITIVE_POLARITY |
VS_OUT_POSITIVE_POLARITY); HS_OUT_POSITIVE_POLARITY |
VS_OUT_POSITIVE_POLARITY);
/* select the format for the input data manager */ /* select the format for the input data manager */
ths8200_write_value(DATA_CNTL_REG, DATA_20BIT_YCBCR_MODE); ths8200_write_value(DATA_CNTL_REG, DATA_20BIT_YCBCR_MODE);
...@@ -331,7 +329,7 @@ int ths8200_set_720p_mode(void) ...@@ -331,7 +329,7 @@ int ths8200_set_720p_mode(void)
ths8200_write_value(DTG1_Y_SYNC1_LSB_REG, 0xFF); ths8200_write_value(DTG1_Y_SYNC1_LSB_REG, 0xFF);
/* set the amplitude of the negative sync and /* set the amplitude of the negative sync and
equalization/serration/broad pulses for the Y channel */ equalization/serration/broad pulses for the Y channel */
ths8200_write_value(DTG1_Y_SYNC2_LSB_REG, 0x49); ths8200_write_value(DTG1_Y_SYNC2_LSB_REG, 0x49);
/* set the amplitude of the positive sync for the Y channel */ /* set the amplitude of the positive sync for the Y channel */
...@@ -344,8 +342,8 @@ int ths8200_set_720p_mode(void) ...@@ -344,8 +342,8 @@ int ths8200_set_720p_mode(void)
ths8200_write_value(DTG1_CBCR_SYNC1_LSB_REG, 0xFF); ths8200_write_value(DTG1_CBCR_SYNC1_LSB_REG, 0xFF);
/* set the amplitude of the negative sync and /* set the amplitude of the negative sync and
equalization/serration/broad pulses for the equalization/serration/broad pulses for the
Cb and Cr channels */ Cb and Cr channels */
ths8200_write_value(DTG1_CBCR_SYNC2_LSB_REG, 0xFF); ths8200_write_value(DTG1_CBCR_SYNC2_LSB_REG, 0xFF);
/* set the amplitude of the positive sync for the Cb and Cr channels */ /* set the amplitude of the positive sync for the Cb and Cr channels */
...@@ -354,13 +352,13 @@ int ths8200_set_720p_mode(void) ...@@ -354,13 +352,13 @@ int ths8200_set_720p_mode(void)
/* set msb for sync1 sync2 and sync3 */ /* set msb for sync1 sync2 and sync3 */
ths8200_write_value(DTG1_CBCR_SYNC_MSB_REG, 0x15); ths8200_write_value(DTG1_CBCR_SYNC_MSB_REG, 0x15);
/* set negative hsync width (half of total width) */ /* set negative hsync width (half of total width) */
ths8200_write_value(DTG1_SPEC_A_REG, 0x28); ths8200_write_value(DTG1_SPEC_A_REG, 0x28);
/* set end of active video to start of negative sync */ /* set end of active video to start of negative sync */
ths8200_write_value(DTG1_SPEC_B_REG, 0x46); ths8200_write_value(DTG1_SPEC_B_REG, 0x46);
/* set positive hsync width (half of total width) */ /* set positive hsync width (half of total width) */
ths8200_write_value(DTG1_SPEC_C_REG, 0x28); ths8200_write_value(DTG1_SPEC_C_REG, 0x28);
/* set LSBs of sync to broad pulse */ /* set LSBs of sync to broad pulse */
...@@ -369,13 +367,13 @@ int ths8200_set_720p_mode(void) ...@@ -369,13 +367,13 @@ int ths8200_set_720p_mode(void)
/* set LSBs of sync to active video */ /* set LSBs of sync to active video */
ths8200_write_value(DTG1_SPEC_E_LSB_REG, 0x2C); ths8200_write_value(DTG1_SPEC_E_LSB_REG, 0x2C);
/* set MSB bit of sync to active video width[6]/sync to broad pulse [7] */ /* set MSB bit of sync to active video width[6]/sync to broad pulse [7] */
ths8200_write_value(DTG1_SPEC_DEH_MSB_REG, 0xC0); ths8200_write_value(DTG1_SPEC_DEH_MSB_REG, 0xC0);
/* set broad pulse duration for SDTV (NA) */ /* set broad pulse duration for SDTV (NA) */
ths8200_write_value(DTG1_SPEC_H_LSB_REG, 0x00); ths8200_write_value(DTG1_SPEC_H_LSB_REG, 0x00);
/* set end of active video to sync LSBs [7:0] */ /* set end of active video to sync LSBs [7:0] */
ths8200_write_value(DTG1_SPEC_K_LSB_REG, 0x46); ths8200_write_value(DTG1_SPEC_K_LSB_REG, 0x46);
/* set end of active video to sync MSBs [2:0] */ /* set end of active video to sync MSBs [2:0] */
...@@ -388,17 +386,17 @@ int ths8200_set_720p_mode(void) ...@@ -388,17 +386,17 @@ int ths8200_set_720p_mode(void)
ths8200_write_value(DTG1_TOTAL_PIXELS_LSB_REG, 0x72); ths8200_write_value(DTG1_TOTAL_PIXELS_LSB_REG, 0x72);
/* set MSB and LSB bit of the starting line number /* set MSB and LSB bit of the starting line number
for the DTG when Vsync input or V-bit is for the DTG when Vsync input or V-bit is
asserted(vertical display control) */ asserted(vertical display control) */
ths8200_write_value(DTG1_FIELDFLIP_LINECNT_MSB_REG, 0x00); ths8200_write_value(DTG1_FIELDFLIP_LINECNT_MSB_REG, 0x00);
ths8200_write_value(DTG1_FIELDFLIP_LINECNT_LSB_REG, 0x01); ths8200_write_value(DTG1_FIELDFLIP_LINECNT_LSB_REG, 0x01);
/* set DTG on and set DTG operation mode to /* set DTG on and set DTG operation mode to
ATSC mode 720P(SMPTE296M progressive)*/ ATSC mode 720P(SMPTE296M progressive)*/
ths8200_write_value(DTG1_MODE_REG, DTG_ON | ATSC_MODE_720P); ths8200_write_value(DTG1_MODE_REG, DTG_ON | ATSC_MODE_720P);
/* set MSB bit of number of lines per frame and /* set MSB bit of number of lines per frame and
number of lines in field 1when in generic mode */ number of lines in field 1when in generic mode */
ths8200_write_value(DTG1_FRAME_FILED_SIZE_MSB_REG, 0x27); ths8200_write_value(DTG1_FRAME_FILED_SIZE_MSB_REG, 0x27);
/* set LSB bit of number of lines per frame when in generic mode */ /* set LSB bit of number of lines per frame when in generic mode */
...@@ -408,23 +406,23 @@ int ths8200_set_720p_mode(void) ...@@ -408,23 +406,23 @@ int ths8200_set_720p_mode(void)
ths8200_write_value(DTG1_FIELDSIZE_LSB_REG, 0xFF); ths8200_write_value(DTG1_FIELDSIZE_LSB_REG, 0xFF);
/* set MSB and LSB bit of the number of pixels that the DTG /* set MSB and LSB bit of the number of pixels that the DTG
startup is horizontally delayed with respect to HS input for startup is horizontally delayed with respect to HS input for
dedicated timing modes or EAV input for embedded dedicated timing modes or EAV input for embedded
timing modes. */ timing modes. */
ths8200_write_value(DTG2_HS_IN_DLY_MSB_REG, 0x00); ths8200_write_value(DTG2_HS_IN_DLY_MSB_REG, 0x00);
ths8200_write_value(DTG2_HS_IN_DLY_LSB_REG, 0x60); ths8200_write_value(DTG2_HS_IN_DLY_LSB_REG, 0x60);
/* set MSB and LSB bit of the number of lines that the DTG /* set MSB and LSB bit of the number of lines that the DTG
startup is vertically delayed with respect to VS input for startup is vertically delayed with respect to VS input for
dedicated timing modes or the line counter value for dedicated timing modes or the line counter value for
embedded timing.*/ embedded timing.*/
ths8200_write_value(DTG2_VS_IN_DLY_MSB_REG, 0x08); ths8200_write_value(DTG2_VS_IN_DLY_MSB_REG, 0x08);
ths8200_write_value(DTG2_VS_IN_DLY_LSB_REG, 0x06); ths8200_write_value(DTG2_VS_IN_DLY_LSB_REG, 0x06);
/* place ths8200 in reset state */ /* place ths8200 in reset state */
ths8200_write_value(CHIP_CTL_REG, CHIP_SOFTWARE_RESET); ths8200_write_value(CHIP_CTL_REG, CHIP_SOFTWARE_RESET);
/* take ths8200 out of reset and in normal operation mode */ /* take ths8200 out of reset and in normal operation mode */
ths8200_write_value(CHIP_CTL_REG, CHIP_SOFTWARE_OUT_OF_RESET); ths8200_write_value(CHIP_CTL_REG, CHIP_SOFTWARE_OUT_OF_RESET);
printk(KERN_INFO "THS8200 set video mode as 720p\n"); printk(KERN_INFO "THS8200 set video mode as 720p\n");
...@@ -435,15 +433,17 @@ int ths8200_set_1080i_mode(void) ...@@ -435,15 +433,17 @@ int ths8200_set_1080i_mode(void)
{ {
FN_IN; FN_IN;
/* place ths8200 in reset state */ /* place ths8200 in reset state */
ths8200_write_value(CHIP_CTL_REG,CHIP_SOFTWARE_RESET | ths8200_write_value(CHIP_CTL_REG,
CHIP_LOW_FREQUENCY); CHIP_SOFTWARE_RESET |
CHIP_LOW_FREQUENCY);
/* take ths8200 out of reset and in normal operation mode */ /* take ths8200 out of reset and in normal operation mode */
ths8200_write_value(CHIP_CTL_REG, CHIP_SOFTWARE_OUT_OF_RESET | ths8200_write_value(CHIP_CTL_REG,
CHIP_LOW_FREQUENCY); CHIP_SOFTWARE_OUT_OF_RESET |
CHIP_LOW_FREQUENCY);
/* place color space conversion control in reset state */ /* place color space conversion control in reset state */
ths8200_write_value(CSC_R11_REG, 0x00); ths8200_write_value(CSC_R11_REG, 0x00);
ths8200_write_value(CSC_R21_REG, 0x00); ths8200_write_value(CSC_R21_REG, 0x00);
ths8200_write_value(CSC_R31_REG, 0x00); ths8200_write_value(CSC_R31_REG, 0x00);
...@@ -457,22 +457,23 @@ int ths8200_set_1080i_mode(void) ...@@ -457,22 +457,23 @@ int ths8200_set_1080i_mode(void)
ths8200_write_value(CSC_OFFS12_REG, 0x00); ths8200_write_value(CSC_OFFS12_REG, 0x00);
ths8200_write_value(CSC_OFFS23_REG, 0x00); ths8200_write_value(CSC_OFFS23_REG, 0x00);
ths8200_write_value(CSC_OFFS3_REG, ths8200_write_value(CSC_OFFS3_REG,
CSC_BYPASSED | CSC_BYPASSED |
CSC_PROTECTION_ON); CSC_PROTECTION_ON);
/* Turn off THS8200 Test Modes */ /* Turn off THS8200 Test Modes */
ths8200_write_value(TST_CNTL1_REG, 0x00); ths8200_write_value(TST_CNTL1_REG, 0x00);
ths8200_write_value(TST_CNTL2_REG, 0x00); ths8200_write_value(TST_CNTL2_REG, 0x00);
/* Turn CSM Off */ /* Turn CSM Off */
ths8200_write_value(CSM_GY_CNTL_MULT_MSB_REG, 0x00); ths8200_write_value(CSM_GY_CNTL_MULT_MSB_REG, 0x00);
/* set YCx20 External Sync */ /* set YCx20 External Sync */
ths8200_write_value(DTG2_CNTL_REG, HS_IN_POSITIVE_POLARITY | ths8200_write_value(DTG2_CNTL_REG,
VS_IN_POSITIVE_POLARITY | HS_IN_POSITIVE_POLARITY |
HS_OUT_POSITIVE_POLARITY | VS_IN_POSITIVE_POLARITY |
VS_OUT_POSITIVE_POLARITY | HS_OUT_POSITIVE_POLARITY |
FID_POLARITY); VS_OUT_POSITIVE_POLARITY |
FID_POLARITY);
/* select the format for the input data manager */ /* select the format for the input data manager */
ths8200_write_value(DATA_CNTL_REG, DATA_20BIT_YCBCR_MODE); ths8200_write_value(DATA_CNTL_REG, DATA_20BIT_YCBCR_MODE);
...@@ -481,7 +482,7 @@ int ths8200_set_1080i_mode(void) ...@@ -481,7 +482,7 @@ int ths8200_set_1080i_mode(void)
ths8200_write_value(DTG1_Y_SYNC1_LSB_REG, 0xFF); ths8200_write_value(DTG1_Y_SYNC1_LSB_REG, 0xFF);
/* set the amplitude of the negative sync and /* set the amplitude of the negative sync and
equalization/serration/broad pulses for the Y channel */ equalization/serration/broad pulses for the Y channel */
ths8200_write_value(DTG1_Y_SYNC2_LSB_REG, 0x49); ths8200_write_value(DTG1_Y_SYNC2_LSB_REG, 0x49);
/* set the amplitude of the positive sync for the Y channel */ /* set the amplitude of the positive sync for the Y channel */
...@@ -491,8 +492,8 @@ int ths8200_set_1080i_mode(void) ...@@ -491,8 +492,8 @@ int ths8200_set_1080i_mode(void)
ths8200_write_value(DTG1_CBCR_SYNC1_LSB_REG, 0xFF); ths8200_write_value(DTG1_CBCR_SYNC1_LSB_REG, 0xFF);
/* set the amplitude of the negative sync and /* set the amplitude of the negative sync and
equalization/serration/broad pulses for the equalization/serration/broad pulses for the
Cb and Cr channels */ Cb and Cr channels */
ths8200_write_value(DTG1_CBCR_SYNC2_LSB_REG, 0xFF); ths8200_write_value(DTG1_CBCR_SYNC2_LSB_REG, 0xFF);
/* set the amplitude of the positive sync for the Cb and Cr channels */ /* set the amplitude of the positive sync for the Cb and Cr channels */
...@@ -507,29 +508,29 @@ int ths8200_set_1080i_mode(void) ...@@ -507,29 +508,29 @@ int ths8200_set_1080i_mode(void)
/* set negative hsync width (half of total width) */ /* set negative hsync width (half of total width) */
ths8200_write_value(DTG1_SPEC_A_REG, 0x2C); ths8200_write_value(DTG1_SPEC_A_REG, 0x2C);
/* set end of active video to start of negative sync */ /* set end of active video to start of negative sync */
ths8200_write_value(DTG1_SPEC_B_REG, 0x58); ths8200_write_value(DTG1_SPEC_B_REG, 0x58);
/* set positive hsync width (half of total width) */ /* set positive hsync width (half of total width) */
ths8200_write_value(DTG1_SPEC_C_REG, 0x2C); ths8200_write_value(DTG1_SPEC_C_REG, 0x2C);
/* set LSBs of sync to broad pulse */ /* set LSBs of sync to broad pulse */
ths8200_write_value(DTG1_SPEC_D_LSB_REG, 0x84); ths8200_write_value(DTG1_SPEC_D_LSB_REG, 0x84);
/* set distance from equalization pulse at center /* set distance from equalization pulse at center
of line to active video*/ of line to active video*/
ths8200_write_value(DTG1_SPEC_D1_REG, 0x00); ths8200_write_value(DTG1_SPEC_D1_REG, 0x00);
/* set LSBs of sync to active video */ /* set LSBs of sync to active video */
ths8200_write_value(DTG1_SPEC_E_LSB_REG, 0xC0); ths8200_write_value(DTG1_SPEC_E_LSB_REG, 0xC0);
/* set MSB bit of sync to active video width[6]/sync to broad pulse [7] */ /* set MSB bit of sync to active video width[6]/sync to broad pulse [7] */
ths8200_write_value(DTG1_SPEC_DEH_MSB_REG, 0x00); ths8200_write_value(DTG1_SPEC_DEH_MSB_REG, 0x00);
/* set broad pulse duration for SDTV (NA) */ /* set broad pulse duration for SDTV (NA) */
ths8200_write_value(DTG1_SPEC_H_LSB_REG, 0x00); ths8200_write_value(DTG1_SPEC_H_LSB_REG, 0x00);
/* set end of active video to sync LSBs [7:0] */ /* set end of active video to sync LSBs [7:0] */
ths8200_write_value(DTG1_SPEC_K_LSB_REG, 0x58); ths8200_write_value(DTG1_SPEC_K_LSB_REG, 0x58);
/* set end of active video to sync MSBs [2:0] */ /* set end of active video to sync MSBs [2:0] */
...@@ -548,17 +549,17 @@ int ths8200_set_1080i_mode(void) ...@@ -548,17 +549,17 @@ int ths8200_set_1080i_mode(void)
ths8200_write_value(DTG1_TOTAL_PIXELS_LSB_REG, 0x98); ths8200_write_value(DTG1_TOTAL_PIXELS_LSB_REG, 0x98);
/* set MSB and LSB bit of the starting line number /* set MSB and LSB bit of the starting line number
for the DTG when Vsync input or V-bit is for the DTG when Vsync input or V-bit is
asserted(vertical display control) */ asserted(vertical display control) */
ths8200_write_value(DTG1_FIELDFLIP_LINECNT_MSB_REG, 0x00); ths8200_write_value(DTG1_FIELDFLIP_LINECNT_MSB_REG, 0x00);
ths8200_write_value(DTG1_FIELDFLIP_LINECNT_LSB_REG, 0x01); ths8200_write_value(DTG1_FIELDFLIP_LINECNT_LSB_REG, 0x01);
/* set DTG on and set DTG operation mode to /* set DTG on and set DTG operation mode to
ATSC mode 1080I(SMPTE274M Interlaced)*/ ATSC mode 1080I(SMPTE274M Interlaced)*/
ths8200_write_value(DTG1_MODE_REG, DTG_ON | ATSC_MODE_1080I); ths8200_write_value(DTG1_MODE_REG, DTG_ON | ATSC_MODE_1080I);
/* set MSB bit of number of lines per frame and /* set MSB bit of number of lines per frame and
number of lines in field 1when in generic mode */ number of lines in field 1when in generic mode */
ths8200_write_value(DTG1_FRAME_FILED_SIZE_MSB_REG, 0x42); ths8200_write_value(DTG1_FRAME_FILED_SIZE_MSB_REG, 0x42);
/* set LSB bit of number of lines per frame when in generic mode */ /* set LSB bit of number of lines per frame when in generic mode */
...@@ -577,45 +578,45 @@ int ths8200_set_1080i_mode(void) ...@@ -577,45 +578,45 @@ int ths8200_set_1080i_mode(void)
ths8200_write_value(DTG2_HDLY_LSB, 0x00); ths8200_write_value(DTG2_HDLY_LSB, 0x00);
/* set LSB bit of the duration of the VS_OUT output signal during /* set LSB bit of the duration of the VS_OUT output signal during
progressive scan video modes or during the vertical blank interval progressive scan video modes or during the vertical blank interval
of field 1 in interlaced video modes. */ of field 1 in interlaced video modes. */
ths8200_write_value(DTG2_VLENGTH1_LSB, 0x05); ths8200_write_value(DTG2_VLENGTH1_LSB, 0x05);
/* set MSB bit of the VS_OUT output signal during progressive scan /* set MSB bit of the VS_OUT output signal during progressive scan
video modes or during the vertical blank interval of field 1 in video modes or during the vertical blank interval of field 1 in
interlaced video modes. */ interlaced video modes. */
ths8200_write_value(DTG2_VLENGTH1_MSB_VDLY1_MSB, 0x00); ths8200_write_value(DTG2_VLENGTH1_MSB_VDLY1_MSB, 0x00);
/* set LSB bit of line number that VS_OUT signal is asserted on for /* set LSB bit of line number that VS_OUT signal is asserted on for
progressive video modes or for field 1 of interlaced video modes. */ progressive video modes or for field 1 of interlaced video modes. */
ths8200_write_value(DTG2_VDLY1_LSB, 0x00); ths8200_write_value(DTG2_VDLY1_LSB, 0x00);
/* set LSB bit of the duration of the VS_OUT output signal during /* set LSB bit of the duration of the VS_OUT output signal during
the vertical blank interval of field 2 in interlaced video modes. the vertical blank interval of field 2 in interlaced video modes.
In progressive video modes, this register must be set to all 0. */ In progressive video modes, this register must be set to all 0. */
ths8200_write_value(DTG2_VLENGTH2_LSB, 0x05); ths8200_write_value(DTG2_VLENGTH2_LSB, 0x05);
/* set the MSB bit of the duration of the VS_OUT output signal /* set the MSB bit of the duration of the VS_OUT output signal
during the vertical blank interval of field2 in interlaced video during the vertical blank interval of field2 in interlaced video
modes.In progressive video modes, this register must be set to all 0.*/ modes.In progressive video modes, this register must be set to all 0.*/
ths8200_write_value(DTG2_VLENGTH2_MSB_VDLY2_MSB, 0x77); ths8200_write_value(DTG2_VLENGTH2_MSB_VDLY2_MSB, 0x77);
/* set LSB bit of the line number that the VS_OUT signal is asserted on /* set LSB bit of the line number that the VS_OUT signal is asserted on
for field 2 of interlaced scan video modes.For progressive scan video for field 2 of interlaced scan video modes.For progressive scan video
modes, this register must be set to all 1. */ modes, this register must be set to all 1. */
ths8200_write_value(DTG2_VDLY2_LSB, 0x00); ths8200_write_value(DTG2_VDLY2_LSB, 0x00);
/* set MSB and LSB bit of the number of pixels that the DTG /* set MSB and LSB bit of the number of pixels that the DTG
startup is horizontally delayed with respect to HS input for startup is horizontally delayed with respect to HS input for
dedicated timing modes or EAV input for embedded dedicated timing modes or EAV input for embedded
timing modes. */ timing modes. */
ths8200_write_value(DTG2_HS_IN_DLY_MSB_REG, 0x00); ths8200_write_value(DTG2_HS_IN_DLY_MSB_REG, 0x00);
ths8200_write_value(DTG2_HS_IN_DLY_LSB_REG, 0x44); ths8200_write_value(DTG2_HS_IN_DLY_LSB_REG, 0x44);
/* set MSB and LSB bit of the number of lines that the DTG /* set MSB and LSB bit of the number of lines that the DTG
startup is vertically delayed with respect to VS input for startup is vertically delayed with respect to VS input for
dedicated timing modes or the line counter value for dedicated timing modes or the line counter value for
embedded timing.*/ embedded timing.*/
ths8200_write_value(DTG2_VS_IN_DLY_MSB_REG, 0x00); ths8200_write_value(DTG2_VS_IN_DLY_MSB_REG, 0x00);
ths8200_write_value(DTG2_VS_IN_DLY_LSB_REG, 0x01); ths8200_write_value(DTG2_VS_IN_DLY_LSB_REG, 0x01);
...@@ -635,8 +636,7 @@ static __init int ths8200_init(void) ...@@ -635,8 +636,7 @@ static __init int ths8200_init(void)
FN_IN; FN_IN;
if (i2c_add_driver(&ths8200_driver)) { if (i2c_add_driver(&ths8200_driver)) {
DPRINTK("Driver registration failed, \ DPRINTK("Driver registration failed, module not inserted.\n");
module not inserted.\n");
return -ENODEV; return -ENODEV;
} }
......
...@@ -225,10 +225,8 @@ static const struct fb_videomode dmfb_modedb[] = { ...@@ -225,10 +225,8 @@ static const struct fb_videomode dmfb_modedb[] = {
* vmode, flag * vmode, flag
*/ */
/* Standard Modes */ /* Standard Modes */
{ "576i", 50, 720, 576, LCD_PANEL_CLOCK, 0, 0, 0, 0, 127, 6, FB_SYNC_BROADCAST, { "576i", 50, 720, 576, LCD_PANEL_CLOCK, 0, 0, 0, 0, 127, 6, FB_SYNC_BROADCAST, FB_VMODE_INTERLACED, 0},
FB_VMODE_INTERLACED, 0}, { "480i", 50, 720, 480, LCD_PANEL_CLOCK, 0, 0, 0, 0, 127, 5, FB_SYNC_BROADCAST, FB_VMODE_INTERLACED, 0},
{ "480i", 50, 720, 480, LCD_PANEL_CLOCK, 0, 0, 0, 0, 127, 5, FB_SYNC_BROADCAST,
FB_VMODE_INTERLACED, 0},
/* Modes provided by THS8200 */ /* Modes provided by THS8200 */
{ "480p", 30, 720, 480, LCD_PANEL_CLOCK, 122, 15, 36, 8, 0x50, 0x5, FB_SYNC_BROADCAST, FB_VMODE_NONINTERLACED, 0}, { "480p", 30, 720, 480, LCD_PANEL_CLOCK, 122, 15, 36, 8, 0x50, 0x5, FB_SYNC_BROADCAST, FB_VMODE_NONINTERLACED, 0},
{ "720p", 30, 1280, 720, LCD_PANEL_CLOCK, 300, 69, 26, 3, 0x50, 0x5, FB_SYNC_BROADCAST, FB_VMODE_NONINTERLACED, 0}, { "720p", 30, 1280, 720, LCD_PANEL_CLOCK, 300, 69, 26, 3, 0x50, 0x5, FB_SYNC_BROADCAST, FB_VMODE_NONINTERLACED, 0},
...@@ -256,11 +254,11 @@ static int dm_venc_mode_set(struct dm_info *dm, const struct fb_videomode *mode) ...@@ -256,11 +254,11 @@ static int dm_venc_mode_set(struct dm_info *dm, const struct fb_videomode *mode)
dispc_reg_out(VENC_HSPLS, mode->hsync_len); dispc_reg_out(VENC_HSPLS, mode->hsync_len);
dispc_reg_out(VENC_VSPLS, mode->vsync_len); dispc_reg_out(VENC_VSPLS, mode->vsync_len);
dispc_reg_out(VENC_HINT, mode->xres + mode->left_margin + dispc_reg_out(VENC_HINT, mode->xres + mode->left_margin +
mode->right_margin); mode->right_margin);
dispc_reg_out(VENC_HSTART, mode->left_margin); dispc_reg_out(VENC_HSTART, mode->left_margin);
dispc_reg_out(VENC_HVALID, mode->xres); dispc_reg_out(VENC_HVALID, mode->xres);
dispc_reg_out(VENC_VINT, mode->yres + mode->upper_margin + dispc_reg_out(VENC_VINT, mode->yres + mode->upper_margin +
mode->lower_margin); mode->lower_margin);
dispc_reg_out(VENC_VSTART, mode->upper_margin); dispc_reg_out(VENC_VSTART, mode->upper_margin);
dispc_reg_out(VENC_VVALID, mode->yres); dispc_reg_out(VENC_VVALID, mode->yres);
/* TODO check vmode (interlaced / progressive)*/ /* TODO check vmode (interlaced / progressive)*/
...@@ -283,34 +281,32 @@ static int dm_venc_mode_set(struct dm_info *dm, const struct fb_videomode *mode) ...@@ -283,34 +281,32 @@ static int dm_venc_mode_set(struct dm_info *dm, const struct fb_videomode *mode)
*/ */
int dm_venc_set_state(struct output_device *od) int dm_venc_set_state(struct output_device *od)
{ {
struct dm_info *dm = struct dm_info *dm = (struct dm_info *)class_get_devdata(&od->class_dev);
(struct dm_info *)class_get_devdata(&od->class_dev);
unsigned long state = od->request_state; unsigned long state = od->request_state;
/* TODO check that the output is in standard mode */ /* TODO check that the output is in standard mode */
switch (state) switch (state)
{ {
case DAVINCIFB_OUT_COMPOSITE: case DAVINCIFB_OUT_COMPOSITE:
dispc_reg_out(VENC_DACSEL, 0x0); dispc_reg_out(VENC_DACSEL, 0x0);
break; break;
case DAVINCIFB_OUT_COMPONENT: case DAVINCIFB_OUT_COMPONENT:
/* Enable Component output; DAC A: Y, DAC B: Pb, DAC C: Pr */ /* Enable Component output; DAC A: Y, DAC B: Pb, DAC C: Pr */
dispc_reg_out(VENC_DACSEL, 0x543); dispc_reg_out(VENC_DACSEL, 0x543);
break; break;
case DAVINCIFB_OUT_SVIDEO: case DAVINCIFB_OUT_SVIDEO:
/* Enable S-Video Output; DAC B: S-Video Y, DAC C: S-Video C */ /* Enable S-Video Output; DAC B: S-Video Y, DAC C: S-Video C */
dispc_reg_out(VENC_DACSEL, 0x210); dispc_reg_out(VENC_DACSEL, 0x210);
break; break;
case DAVINCIFB_OUT_RGB: case DAVINCIFB_OUT_RGB:
/* TODO handle rgb */ /* TODO handle rgb */
printk("rgb!\n"); printk("rgb!\n");
break; break;
default: default:
return -EINVAL; return -EINVAL;
} }
...@@ -320,8 +316,7 @@ int dm_venc_set_state(struct output_device *od) ...@@ -320,8 +316,7 @@ int dm_venc_set_state(struct output_device *od)
/* Returns the current output mode selcted */ /* Returns the current output mode selcted */
int dm_venc_get_status(struct output_device *od) int dm_venc_get_status(struct output_device *od)
{ {
struct dm_info *dm = struct dm_info *dm = (struct dm_info *)class_get_devdata(&od->class_dev);
(struct dm_info *)class_get_devdata(&od->class_dev);
return dm->output_sel; return dm->output_sel;
} }
...@@ -349,7 +344,7 @@ static void enable_digital_output(bool on) ...@@ -349,7 +344,7 @@ static void enable_digital_output(bool on)
if (on) { if (on) {
/* Set PINMUX0 reg to enable LCD /* Set PINMUX0 reg to enable LCD
(all other settings are kept per u-boot) */ (all other settings are kept per u-boot) */
dispc_reg_merge(PINMUX0, PINMUX0_LOEEN, PINMUX0_LOEEN); dispc_reg_merge(PINMUX0, PINMUX0_LOEEN, PINMUX0_LOEEN);
/* Set PCR register for FULL clock */ /* Set PCR register for FULL clock */
...@@ -357,7 +352,7 @@ static void enable_digital_output(bool on) ...@@ -357,7 +352,7 @@ static void enable_digital_output(bool on)
/* Enable video clock output and inverse clock polarity */ /* Enable video clock output and inverse clock polarity */
dispc_reg_out(VENC_VIDCTL, dispc_reg_out(VENC_VIDCTL,
(VENC_VIDCTL_VLCKE | VENC_VIDCTL_VLCKP)); (VENC_VIDCTL_VLCKE | VENC_VIDCTL_VLCKP));
/* Setting DRGB Matrix registers back to default values */ /* Setting DRGB Matrix registers back to default values */
dispc_reg_out(VENC_DRGBX0, 0x00000400); dispc_reg_out(VENC_DRGBX0, 0x00000400);
...@@ -405,7 +400,7 @@ static void enable_digital_output(bool on) ...@@ -405,7 +400,7 @@ static void enable_digital_output(bool on)
/* turning on horizontal and vertical syncs */ /* turning on horizontal and vertical syncs */
dispc_reg_out(VENC_SYNCCTL, dispc_reg_out(VENC_SYNCCTL,
(VENC_SYNCCTL_SYEV|VENC_SYNCCTL_SYEH)); (VENC_SYNCCTL_SYEV|VENC_SYNCCTL_SYEH));
/* Set OSD clock and OSD Sync Adavance registers */ /* Set OSD clock and OSD Sync Adavance registers */
dispc_reg_out(VENC_OSDCLK0, 0); dispc_reg_out(VENC_OSDCLK0, 0);
...@@ -427,91 +422,91 @@ static void enable_digital_output(bool on) ...@@ -427,91 +422,91 @@ static void enable_digital_output(bool on)
/* set VPSS clock */ /* set VPSS clock */
dispc_reg_out(VPSS_CLKCTL, 0x0a); dispc_reg_out(VPSS_CLKCTL, 0x0a);
} else { } else {
/* Initialize the VPSS Clock Control register */ /* Initialize the VPSS Clock Control register */
dispc_reg_out(VPSS_CLKCTL, 0x18); dispc_reg_out(VPSS_CLKCTL, 0x18);
/* Set PINMUX0 reg to enable LCD /* Set PINMUX0 reg to enable LCD
(all other settings are kept per u-boot) */ (all other settings are kept per u-boot) */
dispc_reg_merge(PINMUX0, 0, PINMUX0_LOEEN); dispc_reg_merge(PINMUX0, 0, PINMUX0_LOEEN);
dispc_reg_merge(PINMUX0, 0, PINMUX0_LFLDEN); dispc_reg_merge(PINMUX0, 0, PINMUX0_LFLDEN);
/* disable VCLK output pin enable */ /* disable VCLK output pin enable */
dispc_reg_out(VENC_VIDCTL, 0x1101); dispc_reg_out(VENC_VIDCTL, 0x1101);
/* Disable output sync pins */ /* Disable output sync pins */
dispc_reg_out(VENC_SYNCCTL, 0); dispc_reg_out(VENC_SYNCCTL, 0);
/* Disable DCLOCK */ /* Disable DCLOCK */
dispc_reg_out(VENC_DCLKCTL, 0); dispc_reg_out(VENC_DCLKCTL, 0);
dispc_reg_out(VENC_DRGBX1, 0x0000057C); dispc_reg_out(VENC_DRGBX1, 0x0000057C);
/* Disable LCD output control /* Disable LCD output control
(accepting default polarity) */ (accepting default polarity) */
dispc_reg_out(VENC_LCDOUT, 0); dispc_reg_out(VENC_LCDOUT, 0);
dispc_reg_out(VENC_CMPNT, 0x100); dispc_reg_out(VENC_CMPNT, 0x100);
#if 0 #if 0
/* Enable Video Window 1 / disable video window 0 */ /* Enable Video Window 1 / disable video window 0 */
dispc_reg_out(OSD_VIDWINMD, 0x302); dispc_reg_out(OSD_VIDWINMD, 0x302);
/* Enable OSD Field Inversion for DAVINCIFB_WIN_VID1 Use */ /* Enable OSD Field Inversion for DAVINCIFB_WIN_VID1 Use */
dispc_reg_out(OSD_MODE, 0x200); dispc_reg_out(OSD_MODE, 0x200);
/* Disable DAVINCIFB_WIN_OSD0 Window */ /* Disable DAVINCIFB_WIN_OSD0 Window */
dispc_reg_out(OSD_OSDWIN0MD, 0x00002003); dispc_reg_out(OSD_OSDWIN0MD, 0x00002003);
/* Disable DAVINCIFB_WIN_OSD1 Window */ /* Disable DAVINCIFB_WIN_OSD1 Window */
dispc_reg_out(OSD_OSDWIN1MD, 0x00008002); dispc_reg_out(OSD_OSDWIN1MD, 0x00008002);
/* Set DAVINCIFB_WIN_VID0 window origin and size */ /* Set DAVINCIFB_WIN_VID0 window origin and size */
dispc_reg_out(OSD_VIDWIN0XP, 0); dispc_reg_out(OSD_VIDWIN0XP, 0);
dispc_reg_out(OSD_VIDWIN0YP, 0); dispc_reg_out(OSD_VIDWIN0YP, 0);
dispc_reg_out(OSD_VIDWIN0XL, 0x2d0); dispc_reg_out(OSD_VIDWIN0XL, 0x2d0);
dispc_reg_out(OSD_VIDWIN0YL, 0xf0); dispc_reg_out(OSD_VIDWIN0YL, 0xf0);
/* Set DAVINCIFB_WIN_VID1 window origin and size */ /* Set DAVINCIFB_WIN_VID1 window origin and size */
dispc_reg_out(OSD_VIDWIN1XP, 0); dispc_reg_out(OSD_VIDWIN1XP, 0);
dispc_reg_out(OSD_VIDWIN1YP, 0); dispc_reg_out(OSD_VIDWIN1YP, 0);
dispc_reg_out(OSD_VIDWIN1XL, 0x2d0); dispc_reg_out(OSD_VIDWIN1XL, 0x2d0);
dispc_reg_out(OSD_VIDWIN1YL, 0xf0); dispc_reg_out(OSD_VIDWIN1YL, 0xf0);
/* Set DAVINCIFB_WIN_OSD0 window origin and size */ /* Set DAVINCIFB_WIN_OSD0 window origin and size */
dispc_reg_out(OSD_OSDWIN0XP, 0); dispc_reg_out(OSD_OSDWIN0XP, 0);
dispc_reg_out(OSD_OSDWIN0YP, 0); dispc_reg_out(OSD_OSDWIN0YP, 0);
dispc_reg_out(OSD_OSDWIN0XL, 0x2d0); dispc_reg_out(OSD_OSDWIN0XL, 0x2d0);
dispc_reg_out(OSD_OSDWIN0YL, 0xf0); dispc_reg_out(OSD_OSDWIN0YL, 0xf0);
/* Set DAVINCIFB_WIN_OSD1 window origin and size */ /* Set DAVINCIFB_WIN_OSD1 window origin and size */
dispc_reg_out(OSD_OSDWIN1XP, 0); dispc_reg_out(OSD_OSDWIN1XP, 0);
dispc_reg_out(OSD_OSDWIN1YP, 0); dispc_reg_out(OSD_OSDWIN1YP, 0);
dispc_reg_out(OSD_OSDWIN1XL, 0x2d0); dispc_reg_out(OSD_OSDWIN1XL, 0x2d0);
dispc_reg_out(OSD_OSDWIN1YL, 0xf0); dispc_reg_out(OSD_OSDWIN1YL, 0xf0);
/* Set DAVINCIFB_WIN_OSD1 window origin and size */ /* Set DAVINCIFB_WIN_OSD1 window origin and size */
dispc_reg_out(OSD_CURXP, 0); dispc_reg_out(OSD_CURXP, 0);
dispc_reg_out(OSD_CURYP, 0); dispc_reg_out(OSD_CURYP, 0);
dispc_reg_out(OSD_CURXL, 0x2d0); dispc_reg_out(OSD_CURXL, 0x2d0);
dispc_reg_out(OSD_CURYL, 0xf0); dispc_reg_out(OSD_CURYL, 0xf0);
#endif #endif
dispc_reg_out(VENC_HSPLS, 0); dispc_reg_out(VENC_HSPLS, 0);
dispc_reg_out(VENC_VSPLS, 0); dispc_reg_out(VENC_VSPLS, 0);
dispc_reg_out(VENC_HINT, 0); dispc_reg_out(VENC_HINT, 0);
dispc_reg_out(VENC_HSTART, 0); dispc_reg_out(VENC_HSTART, 0);
dispc_reg_out(VENC_HVALID, 0); dispc_reg_out(VENC_HVALID, 0);
dispc_reg_out(VENC_VINT, 0); dispc_reg_out(VENC_VINT, 0);
dispc_reg_out(VENC_VSTART, 0); dispc_reg_out(VENC_VSTART, 0);
dispc_reg_out(VENC_VVALID, 0); dispc_reg_out(VENC_VVALID, 0);
dispc_reg_out(VENC_HSDLY, 0); dispc_reg_out(VENC_HSDLY, 0);
dispc_reg_out(VENC_VSDLY, 0); dispc_reg_out(VENC_VSDLY, 0);
dispc_reg_out(VENC_YCCCTL, 0); dispc_reg_out(VENC_YCCCTL, 0);
dispc_reg_out(VENC_VSTARTA, 0); dispc_reg_out(VENC_VSTARTA, 0);
/* Set OSD clock and OSD Sync Adavance registers */ /* Set OSD clock and OSD Sync Adavance registers */
dispc_reg_out(VENC_OSDCLK0, 1); dispc_reg_out(VENC_OSDCLK0, 1);
dispc_reg_out(VENC_OSDCLK1, 2); dispc_reg_out(VENC_OSDCLK1, 2);
} }
} }
/* slow down the VCLK to 27MHZ from /* slow down the VCLK to 27MHZ from
...@@ -529,8 +524,7 @@ static inline void slow_down_vclk(void) ...@@ -529,8 +524,7 @@ static inline void slow_down_vclk(void)
/* select MXI mode. Use 27 MHz (from MXI27) /* select MXI mode. Use 27 MHz (from MXI27)
* (DAC clock = 27 MHz).VPBE/Video encoder clock * (DAC clock = 27 MHz).VPBE/Video encoder clock
* is enabled*/ * is enabled*/
outl(VPSS_CLKCTL_ENABLE_VPBE_CLK, outl(VPSS_CLKCTL_ENABLE_VPBE_CLK, VPSS_CLKCTL);
VPSS_CLKCTL);
} }
#if 0 #if 0
static void davincifb_480p_component_config(int on) static void davincifb_480p_component_config(int on)
...@@ -563,7 +557,7 @@ static void davincifb_480p_component_config(int on) ...@@ -563,7 +557,7 @@ static void davincifb_480p_component_config(int on)
dispc_reg_out(OSD_OSDWIN1MD, 0x00008000); dispc_reg_out(OSD_OSDWIN1MD, 0x00008000);
/* Set Timing parameters for 480P frame /* Set Timing parameters for 480P frame
(must match what THS8200 expects) */ (must match what THS8200 expects) */
dispc_reg_out(VENC_HSPLS, BASEX480P); dispc_reg_out(VENC_HSPLS, BASEX480P);
dispc_reg_out(VENC_VSPLS, BASEY480P); dispc_reg_out(VENC_VSPLS, BASEY480P);
dispc_reg_out(VENC_HINT, 858 - 1); dispc_reg_out(VENC_HINT, 858 - 1);
...@@ -608,9 +602,9 @@ static void davincifb_480p_component_config(int on) ...@@ -608,9 +602,9 @@ static void davincifb_480p_component_config(int on)
dispc_reg_out(OSD_CURYL, DISP_YRES480P); dispc_reg_out(OSD_CURYL, DISP_YRES480P);
/* Enable all VENC, non-standard timing mode, /* Enable all VENC, non-standard timing mode,
master timing, HD, progressive */ master timing, HD, progressive */
dispc_reg_out(VENC_VMOD, dispc_reg_out(VENC_VMOD,
(VENC_VMOD_VENC | VENC_VMOD_VMD | VENC_VMOD_HDMD)); (VENC_VMOD_VENC | VENC_VMOD_VMD | VENC_VMOD_HDMD));
printk(KERN_INFO "Davinci set video mode as 480p\n"); printk(KERN_INFO "Davinci set video mode as 480p\n");
} else { } else {
...@@ -693,8 +687,8 @@ static void davincifb_1080i_component_config(int on) ...@@ -693,8 +687,8 @@ static void davincifb_1080i_component_config(int on)
/* Enable all VENC, non-standard timing mode, master timing, HD, interlaced */ /* Enable all VENC, non-standard timing mode, master timing, HD, interlaced */
dispc_reg_out(VENC_VMOD, dispc_reg_out(VENC_VMOD,
(VENC_VMOD_VENC | VENC_VMOD_VMD | (VENC_VMOD_VENC | VENC_VMOD_VMD |
VENC_VMOD_HDMD | VENC_VMOD_NSIT)); VENC_VMOD_HDMD | VENC_VMOD_NSIT));
printk(KERN_INFO "Davinci set video mode as 1080i\n"); printk(KERN_INFO "Davinci set video mode as 1080i\n");
...@@ -731,7 +725,7 @@ static void davincifb_720p_component_config(int on) ...@@ -731,7 +725,7 @@ static void davincifb_720p_component_config(int on)
dispc_reg_out(OSD_OSDWIN1MD, 0x00008000); dispc_reg_out(OSD_OSDWIN1MD, 0x00008000);
/* Set Timing parameters for 720P frame /* Set Timing parameters for 720P frame
(must match what THS8200 expects) */ (must match what THS8200 expects) */
dispc_reg_out(VENC_HSPLS, BASEX720P); dispc_reg_out(VENC_HSPLS, BASEX720P);
dispc_reg_out(VENC_VSPLS, BASEY720P); dispc_reg_out(VENC_VSPLS, BASEY720P);
dispc_reg_out(VENC_HINT, 1649); dispc_reg_out(VENC_HINT, 1649);
...@@ -776,9 +770,9 @@ static void davincifb_720p_component_config(int on) ...@@ -776,9 +770,9 @@ static void davincifb_720p_component_config(int on)
dispc_reg_out(OSD_CURYL, DISP_YRES720P); dispc_reg_out(OSD_CURYL, DISP_YRES720P);
/* Enable all VENC, non-standard timing mode, /* Enable all VENC, non-standard timing mode,
master timing, HD, progressive */ master timing, HD, progressive */
dispc_reg_out(VENC_VMOD, dispc_reg_out(VENC_VMOD,
(VENC_VMOD_VENC | VENC_VMOD_VMD | VENC_VMOD_HDMD)); (VENC_VMOD_VENC | VENC_VMOD_VMD | VENC_VMOD_HDMD));
printk(KERN_INFO "Davinci set video mode as 720p\n"); printk(KERN_INFO "Davinci set video mode as 720p\n");
} else{ } else{
...@@ -845,7 +839,7 @@ static void set_sdram_params(const struct dm_win_info *w, u32 addr, u32 line_len ...@@ -845,7 +839,7 @@ static void set_sdram_params(const struct dm_win_info *w, u32 addr, u32 line_len
* color parameter. * color parameter.
*/ */
static int davincifb_set_attr_blend(struct dm_win_info *w, static int davincifb_set_attr_blend(struct dm_win_info *w,
struct fb_fillrect *r) struct fb_fillrect *r)
{ {
struct fb_info *info = &w->info; struct fb_info *info = &w->info;
struct fb_var_screeninfo *var = &info->var; struct fb_var_screeninfo *var = &info->var;
...@@ -865,8 +859,7 @@ static int davincifb_set_attr_blend(struct dm_win_info *w, ...@@ -865,8 +859,7 @@ static int davincifb_set_attr_blend(struct dm_win_info *w,
* ... Do we want to return an error otherwise? * ... Do we want to return an error otherwise?
*/ */
width_bytes = r->width * var->bits_per_pixel / 8; width_bytes = r->width * var->bits_per_pixel / 8;
start = w->fb_base + r->dy * info->fix.line_length start = w->fb_base + r->dy * info->fix.line_length + r->dx * var->bits_per_pixel / 8;
+ r->dx * var->bits_per_pixel / 8;
blend = (((u8) r->color & 0xf) << 4) | ((u8) r->color); blend = (((u8) r->color & 0xf) << 4) | ((u8) r->color);
while (r->height--) { while (r->height--) {
...@@ -1074,8 +1067,7 @@ static int window_overlap(struct dm_win_info *w, u32 xp, u32 yp, u32 xl, u32 yl) ...@@ -1074,8 +1067,7 @@ static int window_overlap(struct dm_win_info *w, u32 xp, u32 yp, u32 xl, u32 yl)
/* Returns 1 if the window parameters are within DAVINCIFB_WIN_VID0, 0 otherwise */ /* Returns 1 if the window parameters are within DAVINCIFB_WIN_VID0, 0 otherwise */
static int within_vid0_limits(struct dm_win_info *vid0, u32 xp, u32 yp, u32 xl, static int within_vid0_limits(struct dm_win_info *vid0, u32 xp, u32 yp, u32 xl, u32 yl)
u32 yl)
{ {
u32 vid0_xp = 0, vid0_yp = 0, vid0_xl = 0, vid0_yl = 0; u32 vid0_xp = 0, vid0_yp = 0, vid0_xl = 0, vid0_yl = 0;
...@@ -1090,7 +1082,7 @@ static int within_vid0_limits(struct dm_win_info *vid0, u32 xp, u32 yp, u32 xl, ...@@ -1090,7 +1082,7 @@ static int within_vid0_limits(struct dm_win_info *vid0, u32 xp, u32 yp, u32 xl,
/* DAVINCIFB_WIN_VID0 must be large enough to hold all other windows */ /* DAVINCIFB_WIN_VID0 must be large enough to hold all other windows */
static int check_new_vid0_size(struct dm_win_info *vid0, u32 xp0, u32 yp0, static int check_new_vid0_size(struct dm_win_info *vid0, u32 xp0, u32 yp0,
u32 xl0, u32 yl0) u32 xl0, u32 yl0)
{ {
struct dm_win_info *owin; struct dm_win_info *owin;
u32 _xp = 0, _yp = 0, _xl = 0, _yl = 0; u32 _xp = 0, _yp = 0, _xl = 0, _yl = 0;
...@@ -1172,12 +1164,11 @@ static void dm_win_fix_set(struct dm_win_info *w) ...@@ -1172,12 +1164,11 @@ static void dm_win_fix_set(struct dm_win_info *w)
struct fb_info *info = &w->info; struct fb_info *info = &w->info;
info->fix.smem_start = w->fb_base_phys; info->fix.smem_start = w->fb_base_phys;
info->fix.line_length = info->fix.line_length = (info->var.xres_virtual * info->var.bits_per_pixel) / 8;
(info->var.xres_virtual * info->var.bits_per_pixel) / 8;
info->fix.smem_len = w->fb_size; info->fix.smem_len = w->fb_size;
info->fix.type = FB_TYPE_PACKED_PIXELS; info->fix.type = FB_TYPE_PACKED_PIXELS;
info->fix.visual = (info->var.bits_per_pixel <= 8) ? info->fix.visual = (info->var.bits_per_pixel <= 8) ?
FB_VISUAL_PSEUDOCOLOR : FB_VISUAL_TRUECOLOR; FB_VISUAL_PSEUDOCOLOR : FB_VISUAL_TRUECOLOR;
/* some values might change based on check_var, set_par and pan */ /* some values might change based on check_var, set_par and pan */
info->fix.xpanstep = 0; info->fix.xpanstep = 0;
info->fix.ypanstep = 1; info->fix.ypanstep = 1;
...@@ -1263,9 +1254,10 @@ static int dm_win_probe(struct dm_win_info *w) ...@@ -1263,9 +1254,10 @@ static int dm_win_probe(struct dm_win_info *w)
dm_win_fix_set(w); dm_win_fix_set(w);
/* append the list modes */ /* append the list modes */
fb_videomode_to_modelist(dmfb_modedb, ARRAY_SIZE(dmfb_modedb), fb_videomode_to_modelist(dmfb_modedb, ARRAY_SIZE(dmfb_modedb),
&info->modelist); &info->modelist);
if (!fb_find_mode(vinfo, &w->info, NULL, if (!fb_find_mode(vinfo, &w->info, NULL, dmfb_modedb,
dmfb_modedb, ARRAY_SIZE(dmfb_modedb), NULL, is_win(w, DAVINCIFB_WIN_OSD1) ? 4 : 16)) { ARRAY_SIZE(dmfb_modedb), NULL,
is_win(w, DAVINCIFB_WIN_OSD1) ? 4 : 16)) {
return -EINVAL; return -EINVAL;
} }
/* create the fb device */ /* create the fb device */
...@@ -1280,8 +1272,7 @@ static int dm_win_probe(struct dm_win_info *w) ...@@ -1280,8 +1272,7 @@ static int dm_win_probe(struct dm_win_info *w)
switch (info->var.bits_per_pixel) { switch (info->var.bits_per_pixel) {
case 16: case 16:
/* yuv422 */ /* yuv422 */
if (is_win(w, DAVINCIFB_WIN_VID0) || if (is_win(w, DAVINCIFB_WIN_VID0) || is_win(w, DAVINCIFB_WIN_VID1))
is_win(w, DAVINCIFB_WIN_VID1))
bg_color = 0x88; bg_color = 0x88;
break; break;
...@@ -1467,15 +1458,15 @@ static int davincifb_check_var(struct fb_var_screeninfo *var, ...@@ -1467,15 +1458,15 @@ static int davincifb_check_var(struct fb_var_screeninfo *var,
v.xres, v.xres_virtual, v.bits_per_pixel); v.xres, v.xres_virtual, v.bits_per_pixel);
return -EINVAL; return -EINVAL;
} }
if ((w->fb_size) && (v.xres_virtual * v.yres_virtual * v.bits_per_pixel if ((w->fb_size) &&
/ 8 > w->fb_size)) { (v.xres_virtual * v.yres_virtual * v.bits_per_pixel / 8 > w->fb_size)) {
dev_dbg(dev, "Requested resolution too big\n"); dev_dbg(dev, "Requested resolution too big\n");
goto error; goto error;
} }
if (!is_win(w, DAVINCIFB_WIN_VID0)) { if (!is_win(w, DAVINCIFB_WIN_VID0)) {
/* Rule 1 */ /* Rule 1 */
if (!within_vid0_limits(w->dm->windows[DAVINCIFB_WIN_VID0], if (!within_vid0_limits(w->dm->windows[DAVINCIFB_WIN_VID0],
w->x, w->y, v.xres, v.yres)) { w->x, w->y, v.xres, v.yres)) {
dev_dbg(dev, "Window %s isnt fully contained on vid0\n", dev_dbg(dev, "Window %s isnt fully contained on vid0\n",
dm_win_names[w->win]); dm_win_names[w->win]);
//return -EINVAL; //return -EINVAL;
...@@ -1506,18 +1497,15 @@ static int davincifb_check_var(struct fb_var_screeninfo *var, ...@@ -1506,18 +1497,15 @@ static int davincifb_check_var(struct fb_var_screeninfo *var,
} else if (is_win(w, DAVINCIFB_WIN_VID0)) { } else if (is_win(w, DAVINCIFB_WIN_VID0)) {
if (check_new_vid0_size((struct dm_info *)w, w->x, w->y, if (check_new_vid0_size((struct dm_info *)w, w->x, w->y,
v.xres, v.yres)) { v.xres, v.yres)) {
dev_dbg(dev, "vid0 isn't large enough to handle all " dev_dbg(dev, "vid0 isn't large enough to handle all windows\n");
"windows\n");
goto error; goto error;
} }
v.bits_per_pixel = 16; v.bits_per_pixel = 16;
} else if (is_win(w, DAVINCIFB_WIN_VID1)) { } else if (is_win(w, DAVINCIFB_WIN_VID1)) {
/* Rule 11 */ /* Rule 11 */
if (w->dm->windows[DAVINCIFB_WIN_VID0] && if (w->dm->windows[DAVINCIFB_WIN_VID0] &&
((w->dm->windows[DAVINCIFB_WIN_VID0]->x - w->x) ((w->dm->windows[DAVINCIFB_WIN_VID0]->x - w->x) % 16)) {
% 16)) { dev_dbg(dev, "vid1 x should be multiple of 16 from vid0\n");
dev_dbg(dev, "vid1 x should be multiple of 16 from "
"vid0\n");
return -EINVAL; return -EINVAL;
} }
/* Video1 may be in YUV or RGB888 format */ /* Video1 may be in YUV or RGB888 format */
...@@ -1555,8 +1543,7 @@ static int davincifb_set_par(struct fb_info *info) ...@@ -1555,8 +1543,7 @@ static int davincifb_set_par(struct fb_info *info)
/* Memory offsets */ /* Memory offsets */
info->fix.line_length = v->xres_virtual * v->bits_per_pixel / 8; info->fix.line_length = v->xres_virtual * v->bits_per_pixel / 8;
offset = v->yoffset * info->fix.line_length + offset = v->yoffset * info->fix.line_length + v->xoffset * v->bits_per_pixel / 8;
v->xoffset * v->bits_per_pixel / 8;
start = (u32) w->fb_base_phys + offset; start = (u32) w->fb_base_phys + offset;
set_sdram_params(w, start, info->fix.line_length); set_sdram_params(w, start, info->fix.line_length);
...@@ -1602,23 +1589,23 @@ static int davincifb_set_par(struct fb_info *info) ...@@ -1602,23 +1589,23 @@ static int davincifb_set_par(struct fb_info *info)
ths8200_set_480p_mode(); ths8200_set_480p_mode();
/* Enable all VENC, non-standard timing mode, /* Enable all VENC, non-standard timing mode,
* master timing, HD, progressive */ * master timing, HD, progressive */
dispc_reg_out(VENC_VMOD, (VENC_VMOD_VENC | dispc_reg_out(VENC_VMOD,
VENC_VMOD_VMD | VENC_VMOD_HDMD)); (VENC_VMOD_VENC | VENC_VMOD_VMD | VENC_VMOD_HDMD));
} }
else if (!strcmp(dmfb_modedb[mode].name, "720p")) { else if (!strcmp(dmfb_modedb[mode].name, "720p")) {
ths8200_set_720p_mode(); ths8200_set_720p_mode();
/* Enable all VENC, non-standard timing mode, /* Enable all VENC, non-standard timing mode,
* master timing, HD, progressive */ * master timing, HD, progressive */
dispc_reg_out(VENC_VMOD, (VENC_VMOD_VENC | dispc_reg_out(VENC_VMOD,
VENC_VMOD_VMD | VENC_VMOD_HDMD)); (VENC_VMOD_VENC | VENC_VMOD_VMD | VENC_VMOD_HDMD));
} }
else if (!strcmp(dmfb_modedb[mode].name, "1080i")) { else if (!strcmp(dmfb_modedb[mode].name, "1080i")) {
ths8200_set_1080i_mode(); ths8200_set_1080i_mode();
/* Enable all VENC, non-standard timing mode, /* Enable all VENC, non-standard timing mode,
* master timing, HD, interlaced */ * master timing, HD, interlaced */
dispc_reg_out(VENC_VMOD, (VENC_VMOD_VENC | dispc_reg_out(VENC_VMOD,
VENC_VMOD_VMD | VENC_VMOD_HDMD | (VENC_VMOD_VENC | VENC_VMOD_VMD |
VENC_VMOD_NSIT)); VENC_VMOD_HDMD | VENC_VMOD_NSIT));
} }
#endif #endif
} }
...@@ -1693,9 +1680,9 @@ static int davincifb_ioctl(struct fb_info *info, unsigned int cmd, ...@@ -1693,9 +1680,9 @@ static int davincifb_ioctl(struct fb_info *info, unsigned int cmd,
case FBIO_SETZOOM: case FBIO_SETZOOM:
if (copy_from_user(&zoom, argp, sizeof(zoom))) if (copy_from_user(&zoom, argp, sizeof(zoom)))
return -EFAULT; return -EFAULT;
if ((zoom.zoom_h == 2) || (zoom.zoom_h == 0) if ((zoom.zoom_h == 2) || (zoom.zoom_h == 0) ||
|| (zoom.zoom_h == 1) || (zoom.zoom_v == 2) (zoom.zoom_h == 1) || (zoom.zoom_v == 2) ||
|| (zoom.zoom_v == 0) || (zoom.zoom_v == 1)) { (zoom.zoom_v == 0) || (zoom.zoom_v == 1)) {
if (!is_win(w, zoom.window_id)) if (!is_win(w, zoom.window_id))
return -EINVAL; return -EINVAL;
set_zoom(w, zoom.zoom_h, zoom.zoom_v); set_zoom(w, zoom.zoom_h, zoom.zoom_v);
...@@ -1822,8 +1809,7 @@ static int davincifb_pan_display(struct fb_var_screeninfo *var, ...@@ -1822,8 +1809,7 @@ static int davincifb_pan_display(struct fb_var_screeninfo *var,
if ((var->xres_virtual * var->bits_per_pixel / 8) % 32) if ((var->xres_virtual * var->bits_per_pixel / 8) % 32)
return -EINVAL; return -EINVAL;
offset = var->yoffset * info->fix.line_length + offset = var->yoffset * info->fix.line_length + var->xoffset * var->bits_per_pixel / 8;
var->xoffset * var->bits_per_pixel / 8;
start = (u32) w->fb_base_phys + offset; start = (u32) w->fb_base_phys + offset;
if ((dispc_reg_in(VENC_VSTAT) & 0x00000010)==0x10) if ((dispc_reg_in(VENC_VSTAT) & 0x00000010)==0x10)
...@@ -1910,7 +1896,7 @@ static irqreturn_t davincifb_isr(int irq, void *arg) ...@@ -1910,7 +1896,7 @@ static irqreturn_t davincifb_isr(int irq, void *arg)
xchg(&addr, w->sdram_address); xchg(&addr, w->sdram_address);
if (addr) { if (addr) {
set_sdram_params(w, w->sdram_address, set_sdram_params(w, w->sdram_address,
w->info.fix.line_length); w->info.fix.line_length);
w->sdram_address = 0; w->sdram_address = 0;
} }
} }
...@@ -1974,8 +1960,7 @@ static int davincifb_probe(struct platform_device *pdev) ...@@ -1974,8 +1960,7 @@ static int davincifb_probe(struct platform_device *pdev)
} }
/* map the regions */ /* map the regions */
dm->mmio_base = dm->mmio_base = (unsigned long)ioremap(dm->mmio_base_phys, dm->mmio_size);
(unsigned long)ioremap(dm->mmio_base_phys, dm->mmio_size);
if (!dm->mmio_base) { if (!dm->mmio_base) {
dev_err(dm->dev, ": cannot map MMIO\n"); dev_err(dm->dev, ": cannot map MMIO\n");
goto release_mmio; goto release_mmio;
...@@ -2005,24 +1990,19 @@ static int davincifb_probe(struct platform_device *pdev) ...@@ -2005,24 +1990,19 @@ static int davincifb_probe(struct platform_device *pdev)
/* Field Inversion Workaround */ /* Field Inversion Workaround */
dispc_reg_out(OSD_MODE, 0x200); dispc_reg_out(OSD_MODE, 0x200);
dm->windows_mask = (1 << DAVINCIFB_WIN_OSD0) | dm->windows_mask = (1 << DAVINCIFB_WIN_OSD0) |(1 << DAVINCIFB_WIN_OSD1) |
(1 << DAVINCIFB_WIN_OSD1) | (1 << DAVINCIFB_WIN_VID0) | (1 << DAVINCIFB_WIN_VID1);
(1 << DAVINCIFB_WIN_VID0) |
(1 << DAVINCIFB_WIN_VID1);
if (dm_wins_probe(dm) < 0) if (dm_wins_probe(dm) < 0)
goto probe_error; goto probe_error;
/* install our interrupt service routine */ /* install our interrupt service routine */
if (request_irq(IRQ_VENCINT, davincifb_isr, IRQF_SHARED, MODULE_NAME, if (request_irq(IRQ_VENCINT, davincifb_isr, IRQF_SHARED, MODULE_NAME, dm)) {
dm)) { dev_err(dm->dev, MODULE_NAME ": could not install interrupt service routine\n");
dev_err(dm->dev, MODULE_NAME
": could not install interrupt service routine\n");
goto irq_error; goto irq_error;
} }
/* TODO remove this */ /* TODO remove this */
//dm->output_device_config(1); //dm->output_device_config(1);
dm->output = dm->output = video_output_register("venc", dm->dev, dm, &dm_venc_props);
video_output_register("venc", dm->dev, dm, &dm_venc_props);
if (!dm->output) if (!dm->output)
goto venc_error; goto venc_error;
platform_set_drvdata(pdev, dm); platform_set_drvdata(pdev, dm);
...@@ -2104,10 +2084,8 @@ int __init davincifb_setup(char *options) ...@@ -2104,10 +2084,8 @@ int __init davincifb_setup(char *options)
dmparams.format = COMPONENT; dmparams.format = COMPONENT;
} }
} else if (!strncmp(this_opt, "format=", 7)) { } else if (!strncmp(this_opt, "format=", 7)) {
if (dmparams.output == LCD || if (dmparams.output == LCD || dmparams.output == HD720P ||
dmparams.output == HD720P || dmparams.output == HD1080I || dmparams.output == HD480P)
dmparams.output == HD1080I ||
dmparams.output == HD480P)
continue; continue;
if (!strncmp(this_opt + 7, "composite", 9)) if (!strncmp(this_opt + 7, "composite", 9))
dmparams.format = COMPOSITE; dmparams.format = COMPOSITE;
...@@ -2121,8 +2099,7 @@ int __init davincifb_setup(char *options) ...@@ -2121,8 +2099,7 @@ int __init davincifb_setup(char *options)
if (!strncmp(this_opt + 5, "off", 3)) if (!strncmp(this_opt + 5, "off", 3))
dmparams.windows &= ~(1 << DAVINCIFB_WIN_VID0); dmparams.windows &= ~(1 << DAVINCIFB_WIN_VID0);
else if (!parse_win_params(this_opt + 5, else if (!parse_win_params(this_opt + 5,
&xres, &yres, &xpos, &xres, &yres, &xpos, &ypos)) {
&ypos)) {
dmparams.vid0_xres = xres; dmparams.vid0_xres = xres;
dmparams.vid0_yres = yres; dmparams.vid0_yres = yres;
dmparams.vid0_xpos = xpos; dmparams.vid0_xpos = xpos;
...@@ -2132,8 +2109,7 @@ int __init davincifb_setup(char *options) ...@@ -2132,8 +2109,7 @@ int __init davincifb_setup(char *options)
if (!strncmp(this_opt + 5, "off", 3)) if (!strncmp(this_opt + 5, "off", 3))
dmparams.windows &= ~(1 << DAVINCIFB_WIN_VID1); dmparams.windows &= ~(1 << DAVINCIFB_WIN_VID1);
else if (!parse_win_params(this_opt + 5, else if (!parse_win_params(this_opt + 5,
&xres, &yres, &xpos, &xres, &yres, &xpos, &ypos)) {
&ypos)) {
dmparams.vid1_xres = xres; dmparams.vid1_xres = xres;
dmparams.vid1_yres = yres; dmparams.vid1_yres = yres;
dmparams.vid1_xpos = xpos; dmparams.vid1_xpos = xpos;
...@@ -2143,8 +2119,7 @@ int __init davincifb_setup(char *options) ...@@ -2143,8 +2119,7 @@ int __init davincifb_setup(char *options)
if (!strncmp(this_opt + 5, "off", 3)) if (!strncmp(this_opt + 5, "off", 3))
dmparams.windows &= ~(1 << DAVINCIFB_WIN_OSD0); dmparams.windows &= ~(1 << DAVINCIFB_WIN_OSD0);
else if (!parse_win_params(this_opt + 5, else if (!parse_win_params(this_opt + 5,
&xres, &yres, &xpos, &xres, &yres, &xpos, &ypos)) {
&ypos)) {
dmparams.osd0_xres = xres; dmparams.osd0_xres = xres;
dmparams.osd0_yres = yres; dmparams.osd0_yres = yres;
dmparams.osd0_xpos = xpos; dmparams.osd0_xpos = xpos;
...@@ -2154,8 +2129,7 @@ int __init davincifb_setup(char *options) ...@@ -2154,8 +2129,7 @@ int __init davincifb_setup(char *options)
if (!strncmp(this_opt + 5, "off", 3)) if (!strncmp(this_opt + 5, "off", 3))
dmparams.windows &= ~(1 << DAVINCIFB_WIN_OSD1); dmparams.windows &= ~(1 << DAVINCIFB_WIN_OSD1);
else if (!parse_win_params(this_opt + 5, else if (!parse_win_params(this_opt + 5,
&xres, &yres, &xpos, &xres, &yres, &xpos, &ypos)) {
&ypos)) {
dmparams.osd1_xres = xres; dmparams.osd1_xres = xres;
dmparams.osd1_yres = yres; dmparams.osd1_yres = yres;
dmparams.osd1_xpos = xpos; dmparams.osd1_xpos = xpos;
...@@ -2163,12 +2137,11 @@ int __init davincifb_setup(char *options) ...@@ -2163,12 +2137,11 @@ int __init davincifb_setup(char *options)
} }
} }
} }
printk(KERN_INFO "DaVinci: " printk(KERN_INFO "DaVinci: " "Output on %s%s, Enabled windows: %s %s %s %s\n",
"Output on %s%s, Enabled windows: %s %s %s %s\n",
(dmparams.output == LCD) ? "LCD" : (dmparams.output == LCD) ? "LCD" :
(dmparams.output == HD720P) ? "HD720P": (dmparams.output == HD720P) ? "HD720P":
(dmparams.output == HD1080I) ? "HD1080I": (dmparams.output == HD1080I) ? "HD1080I":
(dmparams.output == HD480P) ? "HD480P": (dmparams.output == HD480P) ? "HD480P":
(dmparams.output == NTSC) ? "NTSC" : (dmparams.output == NTSC) ? "NTSC" :
(dmparams.output == PAL) ? "PAL" : "unknown device!", (dmparams.output == PAL) ? "PAL" : "unknown device!",
(dmparams.format == 0) ? "" : (dmparams.format == 0) ? "" :
...@@ -2194,8 +2167,7 @@ int __init davincifb_setup(char *options) ...@@ -2194,8 +2167,7 @@ int __init davincifb_setup(char *options)
format_xres = DISP_XRES480P; format_xres = DISP_XRES480P;
format_yres = DISP_YRES480P; format_yres = DISP_YRES480P;
} else { } else {
printk(KERN_INFO printk(KERN_INFO "DaVinci:invalid format..defaulting width to 480\n");
"DaVinci:invalid format..defaulting width to 480\n");
} }
dmparams.osd0_xres = osd0_default_var.xres = format_xres; dmparams.osd0_xres = osd0_default_var.xres = format_xres;
dmparams.osd1_xres = osd1_default_var.xres = format_xres; dmparams.osd1_xres = osd1_default_var.xres = format_xres;
...@@ -2218,12 +2190,9 @@ int __init davincifb_setup(char *options) ...@@ -2218,12 +2190,9 @@ int __init davincifb_setup(char *options)
vid1_default_var.yres_virtual = format_yres * TRIPLE_BUF; vid1_default_var.yres_virtual = format_yres * TRIPLE_BUF;
dmparams.osd0_phys = DAVINCI_FB_RESERVE_MEM_BASE; dmparams.osd0_phys = DAVINCI_FB_RESERVE_MEM_BASE;
dmparams.osd1_phys = dmparams.osd0_phys + dmparams.osd1_phys = dmparams.osd0_phys + fb_window_size(format_xres, format_yres, DOUBLE_BUF);
fb_window_size(format_xres, format_yres, DOUBLE_BUF); dmparams.vid0_phys = dmparams.osd1_phys + fb_window_size(format_xres, format_yres, DOUBLE_BUF);
dmparams.vid0_phys = dmparams.osd1_phys + dmparams.vid1_phys = dmparams.vid0_phys + fb_window_size(format_xres, format_yres, TRIPLE_BUF);
fb_window_size(format_xres, format_yres, DOUBLE_BUF);
dmparams.vid1_phys = dmparams.vid0_phys +
fb_window_size(format_xres, format_yres, TRIPLE_BUF);
if (dmparams.windows & (1 << DAVINCIFB_WIN_VID0)) if (dmparams.windows & (1 << DAVINCIFB_WIN_VID0))
printk(KERN_INFO "Setting Video0 size %dx%d, " printk(KERN_INFO "Setting Video0 size %dx%d, "
...@@ -2267,12 +2236,11 @@ int __init davincifb_init(void) ...@@ -2267,12 +2236,11 @@ int __init davincifb_init(void)
for (i = 0; i < num_names && !done; i++) { for (i = 0; i < num_names && !done; i++) {
if (fb_get_options(names[i], &option)) { if (fb_get_options(names[i], &option)) {
printk(MODULE_NAME printk(MODULE_NAME ": Disabled on command-line.\n");
": Disabled on command-line.\n");
return -ENODEV; return -ENODEV;
} else if (option) { } else if (option) {
davincifb_setup(option); davincifb_setup(option);
done = 1; done = 1;
} }
} }
#endif #endif
......
Markdown is supported
0%
or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment