drivers/staging/msm/tv_pal.c

   1 /* Copyright (c) 2008-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 #include <linux/module.h>
  18 #include <linux/kernel.h>
  19 #include <linux/sched.h>
  20 #include <linux/time.h>
  21 #include <linux/init.h>
  22 #include <linux/interrupt.h>
  23 #include <linux/spinlock.h>
  24 #include <linux/delay.h>
  25 #include <mach/hardware.h>
  26 #include <linux/io.h>
  27
  28 #include <asm/system.h>
  29 #include <asm/mach-types.h>
  30 #include <linux/semaphore.h>
  31 #include <linux/uaccess.h>
  32 #include <linux/clk.h>
  33
  34 #include "msm_fb.h"
  35 #include "tvenc.h"
  36
  37 #ifdef CONFIG_FB_MSM_TVOUT_PAL_M
  38 #define PAL_TV_DIMENSION_WIDTH      720
  39 #define PAL_TV_DIMENSION_HEIGHT     480
  40 #else
  41 #define PAL_TV_DIMENSION_WIDTH      720
  42 #define PAL_TV_DIMENSION_HEIGHT     576
  43 #endif
  44
  45 static int pal_on(struct platform_device *pdev)
  46 {
  47         uint32 reg = 0;
  48         int ret = 0;
  49         struct msm_fb_data_type *mfd;
  50
  51         mfd = platform_get_drvdata(pdev);
  52
  53         if (!mfd)
  54                 return -ENODEV;
  55
  56         if (mfd->key != MFD_KEY)
  57                 return -EINVAL;
  58
  59         TV_OUT(TV_ENC_CTL, 0);  /* disable TV encoder */
  60
  61         switch (mfd->panel.id) {
  62         case PAL_BDGHIN:
  63                 /* Cr gain 11, Cb gain C6, y_gain 97 */
  64                 TV_OUT(TV_GAIN, 0x0088c1a0);
  65                 TV_OUT(TV_CGMS, 0x00012345);
  66                 TV_OUT(TV_TEST_MUX, 0x0);
  67                 /*  PAL Timing */
  68                 TV_OUT(TV_SYNC_1, 0x00180097);
  69                 TV_OUT(TV_SYNC_2, 0x011f06c0);
  70                 TV_OUT(TV_SYNC_3, 0x0005000a);
  71                 TV_OUT(TV_SYNC_4, 0x00320271);
  72                 TV_OUT(TV_SYNC_5, 0x005602f9);
  73                 TV_OUT(TV_SYNC_6, 0x0005000a);
  74                 TV_OUT(TV_SYNC_7, 0x0000000f);
  75                 TV_OUT(TV_BURST_V1, 0x0012026e);
  76                 TV_OUT(TV_BURST_V2, 0x0011026d);
  77                 TV_OUT(TV_BURST_V3, 0x00100270);
  78                 TV_OUT(TV_BURST_V4, 0x0013026f);
  79                 TV_OUT(TV_BURST_H, 0x00af00ea);
  80                 TV_OUT(TV_SOL_REQ_ODD, 0x0030026e);
  81                 TV_OUT(TV_SOL_REQ_EVEN, 0x0031026f);
  82
  83                 reg |= TVENC_CTL_TV_MODE_PAL_BDGHIN;
  84                 break;
  85         case PAL_M:
  86                 /* Cr gain 11, Cb gain C6, y_gain 97 */
  87                 TV_OUT(TV_GAIN, 0x0081b697);
  88                 TV_OUT(TV_CGMS, 0x000af317);
  89                 TV_OUT(TV_TEST_MUX, 0x000001c3);
  90                 TV_OUT(TV_TEST_MODE, 0x00000002);
  91                 /*  PAL Timing */
  92                 TV_OUT(TV_SYNC_1, 0x0020009e);
  93                 TV_OUT(TV_SYNC_2, 0x011306b4);
  94                 TV_OUT(TV_SYNC_3, 0x0006000c);
  95                 TV_OUT(TV_SYNC_4, 0x0028020D);
  96                 TV_OUT(TV_SYNC_5, 0x005e02fb);
  97                 TV_OUT(TV_SYNC_6, 0x0006000c);
  98                 TV_OUT(TV_SYNC_7, 0x00000012);
  99                 TV_OUT(TV_BURST_V1, 0x0012020b);
 100                 TV_OUT(TV_BURST_V2, 0x0016020c);
 101                 TV_OUT(TV_BURST_V3, 0x00150209);
 102                 TV_OUT(TV_BURST_V4, 0x0013020c);
 103                 TV_OUT(TV_BURST_H, 0x00bf010b);
 104                 TV_OUT(TV_SOL_REQ_ODD, 0x00280208);
 105                 TV_OUT(TV_SOL_REQ_EVEN, 0x00290209);
 106
 107                 reg |= TVENC_CTL_TV_MODE_PAL_M;
 108                 break;
 109         case PAL_N:
 110                 /* Cr gain 11, Cb gain C6, y_gain 97 */
 111                 TV_OUT(TV_GAIN, 0x0081b697);
 112                 TV_OUT(TV_CGMS, 0x000af317);
 113                 TV_OUT(TV_TEST_MUX, 0x000001c3);
 114                 TV_OUT(TV_TEST_MODE, 0x00000002);
 115                 /*  PAL Timing */
 116                 TV_OUT(TV_SYNC_1, 0x00180097);
 117                 TV_OUT(TV_SYNC_2, 0x12006c0);
 118                 TV_OUT(TV_SYNC_3, 0x0005000a);
 119                 TV_OUT(TV_SYNC_4, 0x00320271);
 120                 TV_OUT(TV_SYNC_5, 0x005602f9);
 121                 TV_OUT(TV_SYNC_6, 0x0005000a);
 122                 TV_OUT(TV_SYNC_7, 0x0000000f);
 123                 TV_OUT(TV_BURST_V1, 0x0012026e);
 124                 TV_OUT(TV_BURST_V2, 0x0011026d);
 125                 TV_OUT(TV_BURST_V3, 0x00100270);
 126                 TV_OUT(TV_BURST_V4, 0x0013026f);
 127                 TV_OUT(TV_BURST_H, 0x00af00fa);
 128                 TV_OUT(TV_SOL_REQ_ODD, 0x0030026e);
 129                 TV_OUT(TV_SOL_REQ_EVEN, 0x0031026f);
 130
 131                 reg |= TVENC_CTL_TV_MODE_PAL_N;
 132                 break;
 133
 134         default:
 135                 return -ENODEV;
 136         }
 137
 138         reg |= TVENC_CTL_Y_FILTER_EN |
 139             TVENC_CTL_CR_FILTER_EN |
 140             TVENC_CTL_CB_FILTER_EN | TVENC_CTL_SINX_FILTER_EN;
 141 #ifdef CONFIG_FB_MSM_TVOUT_SVIDEO
 142         reg |= TVENC_CTL_S_VIDEO_EN;
 143 #endif
 144
 145         TV_OUT(TV_LEVEL, 0x00000000);   /* DC offset to 0. */
 146         TV_OUT(TV_OFFSET, 0x008080f0);
 147
 148 #ifdef CONFIG_FB_MSM_MDP31
 149         TV_OUT(TV_DAC_INTF, 0x29);
 150 #endif
 151         TV_OUT(TV_ENC_CTL, reg);
 152
 153         reg |= TVENC_CTL_ENC_EN;
 154         TV_OUT(TV_ENC_CTL, reg);
 155
 156         return ret;
 157 }
 158
 159 static int pal_off(struct platform_device *pdev)
 160 {
 161         TV_OUT(TV_ENC_CTL, 0);  /* disable TV encoder */
 162         return 0;
 163 }
 164
 165 static int __init pal_probe(struct platform_device *pdev)
 166 {
 167         msm_fb_add_device(pdev);
 168
 169         return 0;
 170 }
 171
 172 static struct platform_driver this_driver = {
 173         .probe  = pal_probe,
 174         .driver = {
 175                 .name   = "tv_pal",
 176         },
 177 };
 178
 179 static struct msm_fb_panel_data pal_panel_data = {
 180         .panel_info.xres = PAL_TV_DIMENSION_WIDTH,
 181         .panel_info.yres = PAL_TV_DIMENSION_HEIGHT,
 182         .panel_info.type = TV_PANEL,
 183         .panel_info.pdest = DISPLAY_1,
 184         .panel_info.wait_cycle = 0,
 185         .panel_info.bpp = 16,
 186         .panel_info.fb_num = 2,
 187         .on = pal_on,
 188         .off = pal_off,
 189 };
 190
 191 static struct platform_device this_device = {
 192         .name   = "tv_pal",
 193         .id     = 0,
 194         .dev    = {
 195                 .platform_data = &pal_panel_data,
 196         }
 197 };
 198
 199 static int __init pal_init(void)
 200 {
 201         int ret;
 202
 203         ret = platform_driver_register(&this_driver);
 204         if (!ret) {
 205                 ret = platform_device_register(&this_device);
 206                 if (ret)
 207                         platform_driver_unregister(&this_driver);
 208         }
 209
 210         return ret;
 211 }
 212
 213 module_init(pal_init);