Linux/drivers/staging/msm/hdmi_sii9022.c

  1 /* Copyright (c) 2009, Code Aurora Forum. All rights reserved.
  2  *
  3  * This program is free software; you can redistribute it and/or modify
  4  * it under the terms of the GNU General Public License version 2 and
  5  * only version 2 as published by the Free Software Foundation.
  6  *
  7  * This program is distributed in the hope that it will be useful,
  8  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  9  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 10  * GNU General Public License for more details.
 11  *
 12  * You should have received a copy of the GNU General Public License
 13  * along with this program; if not, write to the Free Software
 14  * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA
 15  * 02110-1301, USA.
 16  */
 17 
 18 #include <linux/i2c.h>
 19 #include <linux/delay.h>
 20 #include "msm_fb.h"
 21 
 22 #define DEVICE_NAME "sii9022"
 23 #define SII9022_DEVICE_ID   0xB0
 24 
 25 struct sii9022_i2c_addr_data{
 26         u8 addr;
 27         u8 data;
 28 };
 29 
 30 /* video mode data */
 31 static u8 video_mode_data[] = {
 32         0x00,
 33         0xF9, 0x1C, 0x70, 0x17, 0x72, 0x06, 0xEE, 0x02,
 34 };
 35 
 36 static u8 avi_io_format[] = {
 37         0x09,
 38         0x00, 0x00,
 39 };
 40 
 41 /* power state */
 42 static struct sii9022_i2c_addr_data regset0[] = {
 43         { 0x60, 0x04 },
 44         { 0x63, 0x00 },
 45         { 0x1E, 0x00 },
 46 };
 47 
 48 static u8 video_infoframe[] = {
 49         0x0C,
 50         0xF0, 0x00, 0x68, 0x00, 0x04, 0x00, 0x19, 0x00,
 51         0xE9, 0x02, 0x04, 0x01, 0x04, 0x06,
 52 };
 53 
 54 /* configure audio */
 55 static struct sii9022_i2c_addr_data regset1[] = {
 56         { 0x26, 0x90 },
 57         { 0x20, 0x90 },
 58         { 0x1F, 0x80 },
 59         { 0x26, 0x80 },
 60         { 0x24, 0x02 },
 61         { 0x25, 0x0B },
 62         { 0xBC, 0x02 },
 63         { 0xBD, 0x24 },
 64         { 0xBE, 0x02 },
 65 };
 66 
 67 /* enable audio */
 68 static u8 misc_infoframe[] = {
 69         0xBF,
 70         0xC2, 0x84, 0x01, 0x0A, 0x6F, 0x02, 0x00, 0x00,
 71         0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 72 };
 73 
 74 /* set HDMI, active */
 75 static struct sii9022_i2c_addr_data regset2[] = {
 76         { 0x1A, 0x01 },
 77         { 0x3D, 0x00 },
 78 };
 79 
 80 static int send_i2c_data(struct i2c_client *client,
 81                          struct sii9022_i2c_addr_data *regset,
 82                          int size)
 83 {
 84         int i;
 85         int rc = 0;
 86 
 87         for (i = 0; i < size; i++) {
 88                 rc = i2c_smbus_write_byte_data(
 89                         client,
 90                         regset[i].addr, regset[i].data);
 91                 if (rc)
 92                         break;
 93         }
 94         return rc;
 95 }
 96 
 97 static int hdmi_sii_enable(struct i2c_client *client)
 98 {
 99         int rc;
100         int retries = 10;
101         int count;
102 
103         rc = i2c_smbus_write_byte_data(client, 0xC7, 0x00);
104         if (rc)
105                 goto enable_exit;
106 
107         do {
108                 msleep(1);
109                 rc = i2c_smbus_read_byte_data(client, 0x1B);
110         } while ((rc != SII9022_DEVICE_ID) && retries--);
111 
112         if (rc != SII9022_DEVICE_ID)
113                 return -ENODEV;
114 
115         rc = i2c_smbus_write_byte_data(client, 0x1A, 0x11);
116         if (rc)
117                 goto enable_exit;
118 
119         count = ARRAY_SIZE(video_mode_data);
120         rc = i2c_master_send(client, video_mode_data, count);
121         if (rc != count) {
122                 rc = -EIO;
123                 goto enable_exit;
124         }
125 
126         rc = i2c_smbus_write_byte_data(client, 0x08, 0x20);
127         if (rc)
128                 goto enable_exit;
129         count = ARRAY_SIZE(avi_io_format);
130         rc = i2c_master_send(client, avi_io_format, count);
131         if (rc != count) {
132                 rc = -EIO;
133                 goto enable_exit;
134         }
135 
136         rc = send_i2c_data(client, regset0, ARRAY_SIZE(regset0));
137         if (rc)
138                 goto enable_exit;
139 
140         count = ARRAY_SIZE(video_infoframe);
141         rc = i2c_master_send(client, video_infoframe, count);
142         if (rc != count) {
143                 rc = -EIO;
144                 goto enable_exit;
145         }
146 
147         rc = send_i2c_data(client, regset1, ARRAY_SIZE(regset1));
148         if (rc)
149                 goto enable_exit;
150 
151         count = ARRAY_SIZE(misc_infoframe);
152         rc = i2c_master_send(client, misc_infoframe, count);
153         if (rc != count) {
154                 rc = -EIO;
155                 goto enable_exit;
156         }
157 
158         rc = send_i2c_data(client, regset2, ARRAY_SIZE(regset2));
159         if (rc)
160                 goto enable_exit;
161 
162         return 0;
163 enable_exit:
164         printk(KERN_ERR "%s: exited rc=%d\n", __func__, rc);
165         return rc;
166 }
167 
168 static const struct i2c_device_id hmdi_sii_id[] = {
169         { DEVICE_NAME, 0 },
170         { }
171 };
172 
173 static int hdmi_sii_probe(struct i2c_client *client,
174                         const struct i2c_device_id *id)
175 {
176         int rc;
177 
178         if (!i2c_check_functionality(client->adapter,
179                                      I2C_FUNC_SMBUS_BYTE | I2C_FUNC_I2C))
180                 return -ENODEV;
181         rc = hdmi_sii_enable(client);
182         return rc;
183 }
184 
185 
186 static struct i2c_driver hdmi_sii_i2c_driver = {
187         .driver = {
188                 .name = DEVICE_NAME,
189                 .owner = THIS_MODULE,
190         },
191         .probe = hdmi_sii_probe,
192         .remove =  __exit_p(hdmi_sii_remove),
193         .id_table = hmdi_sii_id,
194 };
195 
196 static int __init hdmi_sii_init(void)
197 {
198         int ret;
199         struct msm_panel_info pinfo;
200 
201         if (msm_fb_detect_client("hdmi_sii9022"))
202                 return 0;
203 
204         pinfo.xres = 1280;
205         pinfo.yres = 720;
206         pinfo.type = HDMI_PANEL;
207         pinfo.pdest = DISPLAY_1;
208         pinfo.wait_cycle = 0;
209         pinfo.bpp = 24;
210         pinfo.fb_num = 2;
211         pinfo.clk_rate = 74250000;
212 
213         pinfo.lcdc.h_back_porch = 124;
214         pinfo.lcdc.h_front_porch = 110;
215         pinfo.lcdc.h_pulse_width = 136;
216         pinfo.lcdc.v_back_porch = 19;
217         pinfo.lcdc.v_front_porch = 5;
218         pinfo.lcdc.v_pulse_width = 6;
219         pinfo.lcdc.border_clr = 0;
220         pinfo.lcdc.underflow_clr = 0xff;
221         pinfo.lcdc.hsync_skew = 0;
222 
223         ret = lcdc_device_register(&pinfo);
224         if (ret) {
225                 printk(KERN_ERR "%s: failed to register device\n", __func__);
226                 goto init_exit;
227         }
228 
229         ret = i2c_add_driver(&hdmi_sii_i2c_driver);
230         if (ret)
231                 printk(KERN_ERR "%s: failed to add i2c driver\n", __func__);
232 
233 init_exit:
234         return ret;
235 }
236 
237 static void __exit hdmi_sii_exit(void)
238 {
239         i2c_del_driver(&hdmi_sii_i2c_driver);
240 }
241 
242 module_init(hdmi_sii_init);
243 module_exit(hdmi_sii_exit);
244 MODULE_LICENSE("GPL v2");
245 MODULE_VERSION("0.1");
246 MODULE_AUTHOR("Qualcomm Innovation Center, Inc.");
247 MODULE_DESCRIPTION("SiI9022 HDMI driver");
248 MODULE_ALIAS("platform:hdmi-sii9022");
249 

This page was automatically generated by LXR 0.3.1 (source).  •  Linux is a registered trademark of Linus Torvalds  •  Contact us