API tools faq
paste
blackswords

Maple LCD source

blackswords
May 27th, 2012
137
0
Never
Add comment
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
C++ 22.54 KB | None | 0 0
raw download clone embed print report
  1. /*
  2.  * LCD.cpp
  3.  *
  4.  *  Created on: 17 févr. 2012
  5.  *      Author: blackswords
  6.  */
  7.  
  8. #include "LCD.h"
  9.  
  10. #define LCD_REG              (*((volatile unsigned short *) 0x60000000)) /* RS = 0 */
  11. #define LCD_RAM              (*((volatile unsigned short *) 0x60020000)) /* RS = 1 */
  12.  
  13. LCD::LCD() {
  14.  
  15.     LCD::FSMCConfig();
  16.     LCD::Inner_delay(50);  /* delay 50 ms */
  17.     //LCD_DeviceCode = LCD::ReadReg(0x0000);
  18.  
  19.     if(LCD_DeviceCode==0x9325 || LCD_DeviceCode==0x9328)
  20.     {
  21.         LCD::WriteReg(0x00e7,0x0010);
  22.         LCD::WriteReg(0x0000,0x0001);   /* start internal osc */
  23.         LCD::WriteReg(0x0001,0x0100);
  24.         LCD::WriteReg(0x0002,0x0700);   /* power on sequence */
  25.         LCD::WriteReg(0x0003,(1<<12)|(1<<5)|(1<<4)|(0<<3) );    /* importance */
  26.         LCD::WriteReg(0x0004,0x0000);
  27.         LCD::WriteReg(0x0008,0x0207);
  28.         LCD::WriteReg(0x0009,0x0000);
  29.         LCD::WriteReg(0x000a,0x0000);   /* display setting */
  30.         LCD::WriteReg(0x000c,0x0001);   /* display setting */
  31.         LCD::WriteReg(0x000d,0x0000);
  32.         LCD::WriteReg(0x000f,0x0000);
  33.         /* Power On sequence */
  34.         LCD::WriteReg(0x0010,0x0000);
  35.         LCD::WriteReg(0x0011,0x0007);
  36.         LCD::WriteReg(0x0012,0x0000);
  37.         LCD::WriteReg(0x0013,0x0000);
  38.         LCD::Inner_delay(50);  /* delay 50 ms */
  39.         LCD::WriteReg(0x0010,0x1590);
  40.         LCD::WriteReg(0x0011,0x0227);
  41.         LCD::Inner_delay(50);  /* delay 50 ms */
  42.         LCD::WriteReg(0x0012,0x009c);
  43.         LCD::Inner_delay(50);  /* delay 50 ms */
  44.         LCD::WriteReg(0x0013,0x1900);
  45.         LCD::WriteReg(0x0029,0x0023);
  46.         LCD::WriteReg(0x002b,0x000e);
  47.         LCD::Inner_delay(50);  /* delay 50 ms */
  48.         LCD::WriteReg(0x0020,0x0000);
  49.         LCD::WriteReg(0x0021,0x0000);
  50.         LCD::Inner_delay(50);  /* delay 50 ms */
  51.         LCD::WriteReg(0x0030,0x0007);
  52.         LCD::WriteReg(0x0031,0x0707);
  53.         LCD::WriteReg(0x0032,0x0006);
  54.         LCD::WriteReg(0x0035,0x0704);
  55.         LCD::WriteReg(0x0036,0x1f04);
  56.         LCD::WriteReg(0x0037,0x0004);
  57.         LCD::WriteReg(0x0038,0x0000);
  58.         LCD::WriteReg(0x0039,0x0706);
  59.         LCD::WriteReg(0x003c,0x0701);
  60.         LCD::WriteReg(0x003d,0x000f);
  61.         LCD::Inner_delay(50);  /* delay 50 ms */
  62.         LCD::WriteReg(0x0050,0x0000);
  63.         LCD::WriteReg(0x0051,0x00ef);
  64.         LCD::WriteReg(0x0052,0x0000);
  65.         LCD::WriteReg(0x0053,0x013f);
  66.         LCD::WriteReg(0x0060,0xa700);
  67.         LCD::WriteReg(0x0061,0x0001);
  68.         LCD::WriteReg(0x006a,0x0000);
  69.         LCD::WriteReg(0x0080,0x0000);
  70.         LCD::WriteReg(0x0081,0x0000);
  71.         LCD::WriteReg(0x0082,0x0000);
  72.         LCD::WriteReg(0x0083,0x0000);
  73.         LCD::WriteReg(0x0084,0x0000);
  74.         LCD::WriteReg(0x0085,0x0000);
  75.  
  76.         LCD::WriteReg(0x0090,0x0010);
  77.         LCD::WriteReg(0x0092,0x0000);
  78.         LCD::WriteReg(0x0093,0x0003);
  79.         LCD::WriteReg(0x0095,0x0110);
  80.         LCD::WriteReg(0x0097,0x0000);
  81.         LCD::WriteReg(0x0098,0x0000);
  82.         /* display on sequence */
  83.         LCD::WriteReg(0x0007,0x0133);
  84.  
  85.         LCD::WriteReg(0x0020,0x0000);
  86.         LCD::WriteReg(0x0021,0x0000);
  87.     }
  88.     else if(LCD_DeviceCode==0x9320 || LCD_DeviceCode==0x9300)
  89.     {
  90.         LCD::WriteReg(0x00,0x0000);
  91.         LCD::WriteReg(0x01,0x0100); /* Driver Output Contral */
  92.         LCD::WriteReg(0x02,0x0700); /* LCD Driver Waveform Contral */
  93.         LCD::WriteReg(0x03,0x1018); /* Entry Mode Set */
  94.  
  95.         LCD::WriteReg(0x04,0x0000); /* Scalling Contral */
  96.         LCD::WriteReg(0x08,0x0202); /* Display Contral */
  97.         LCD::WriteReg(0x09,0x0000); /* Display Contral 3.(0x0000) */
  98.         LCD::WriteReg(0x0a,0x0000); /* Frame Cycle Contal.(0x0000) */
  99.         LCD::WriteReg(0x0c,(1<<0)); /* Extern Display Interface Contral */
  100.         LCD::WriteReg(0x0d,0x0000); /* Frame Maker Position */
  101.         LCD::WriteReg(0x0f,0x0000); /* Extern Display Interface Contral 2. */
  102.  
  103.         LCD::Inner_delay(100);  /* delay 100 ms */
  104.         LCD::WriteReg(0x07,0x0101); /* Display Contral */
  105.         LCD::Inner_delay(100);  /* delay 100 ms */
  106.  
  107.         LCD::WriteReg(0x10,(1<<12)|(0<<8)|(1<<7)|(1<<6)|(0<<4));    /* Power Control 1.(0x16b0) */
  108.         LCD::WriteReg(0x11,0x0007);                             /* Power Control 2 */
  109.         LCD::WriteReg(0x12,(1<<8)|(1<<4)|(0<<0));               /* Power Control 3.(0x0138) */
  110.         LCD::WriteReg(0x13,0x0b00);                             /* Power Control 4 */
  111.         LCD::WriteReg(0x29,0x0000);                             /* Power Control 7 */
  112.  
  113.         LCD::WriteReg(0x2b,(1<<14)|(1<<4));
  114.  
  115.         LCD::WriteReg(0x50,0);       /* Set X Start */
  116.         LCD::WriteReg(0x51,239);        /* Set X End */
  117.         LCD::WriteReg(0x52,0);      /* Set Y Start */
  118.         LCD::WriteReg(0x53,319);        /* Set Y End */
  119.  
  120.         LCD::WriteReg(0x60,0x2700); /* Driver Output Control */
  121.         LCD::WriteReg(0x61,0x0001); /* Driver Output Control */
  122.         LCD::WriteReg(0x6a,0x0000); /* Vertical Srcoll Control */
  123.  
  124.         LCD::WriteReg(0x80,0x0000); /* Display Position? Partial Display 1 */
  125.         LCD::WriteReg(0x81,0x0000); /* RAM Address Start? Partial Display 1 */
  126.         LCD::WriteReg(0x82,0x0000); /* RAM Address End-Partial Display 1 */
  127.         LCD::WriteReg(0x83,0x0000); /* Displsy Position? Partial Display 2 */
  128.         LCD::WriteReg(0x84,0x0000); /* RAM Address Start? Partial Display 2 */
  129.         LCD::WriteReg(0x85,0x0000); /* RAM Address End? Partial Display 2 */
  130.  
  131.         LCD::WriteReg(0x90,(0<<7)|(16<<0)); /* Frame Cycle Contral.(0x0013) */
  132.         LCD::WriteReg(0x92,0x0000); /* Panel Interface Contral 2.(0x0000) */
  133.         LCD::WriteReg(0x93,0x0001); /* Panel Interface Contral 3. */
  134.         LCD::WriteReg(0x95,0x0110); /* Frame Cycle Contral.(0x0110) */
  135.         LCD::WriteReg(0x97,(0<<8));
  136.         LCD::WriteReg(0x98,0x0000); /* Frame Cycle Contral */
  137.  
  138.         LCD::WriteReg(0x07,0x0173);
  139.     }
  140.     else if(LCD_DeviceCode==0x9331)
  141.     {
  142.         LCD::WriteReg(0x00E7, 0x1014);
  143.         LCD::WriteReg(0x0001, 0x0100);   /* set SS and SM bit */
  144.         LCD::WriteReg(0x0002, 0x0200);   /* set 1 line inversion */
  145.         LCD::WriteReg(0x0003, 0x1030);   /* set GRAM write direction and BGR=1 */
  146.         LCD::WriteReg(0x0008, 0x0202);   /* set the back porch and front porch */
  147.         LCD::WriteReg(0x0009, 0x0000);   /* set non-display area refresh cycle ISC[3:0] */
  148.         LCD::WriteReg(0x000A, 0x0000);   /* FMARK function */
  149.         LCD::WriteReg(0x000C, 0x0000);   /* RGB interface setting */
  150.         LCD::WriteReg(0x000D, 0x0000);   /* Frame marker Position */
  151.         LCD::WriteReg(0x000F, 0x0000);   /* RGB interface polarity */
  152.         /* Power On sequence */
  153.         LCD::WriteReg(0x0010, 0x0000);   /* SAP, BT[3:0], AP, DSTB, SLP, STB    */
  154.         LCD::WriteReg(0x0011, 0x0007);   /* DC1[2:0], DC0[2:0], VC[2:0] */
  155.         LCD::WriteReg(0x0012, 0x0000);   /* VREG1OUT voltage    */
  156.         LCD::WriteReg(0x0013, 0x0000);   /* VDV[4:0] for VCOM amplitude */
  157.         LCD::Inner_delay(200);                  /* delay 200 ms */
  158.         LCD::WriteReg(0x0010, 0x1690);   /* SAP, BT[3:0], AP, DSTB, SLP, STB    */
  159.         LCD::WriteReg(0x0011, 0x0227);   /* DC1[2:0], DC0[2:0], VC[2:0] */
  160.         LCD::Inner_delay(50);                   /* delay 50 ms */
  161.         LCD::WriteReg(0x0012, 0x000C);   /* Internal reference voltage= Vci */
  162.         LCD::Inner_delay(50);                    /* delay 50 ms */
  163.         LCD::WriteReg(0x0013, 0x0800);   /* Set VDV[4:0] for VCOM amplitude */
  164.         LCD::WriteReg(0x0029, 0x0011);   /* Set VCM[5:0] for VCOMH */
  165.         LCD::WriteReg(0x002B, 0x000B);   /* Set Frame Rate */
  166.         LCD::Inner_delay(50);                   /* delay 50 ms */
  167.         LCD::WriteReg(0x0020, 0x0000);   /* GRAM horizontal Address */
  168.         LCD::WriteReg(0x0021, 0x0000);   /* GRAM Vertical Address */
  169.         /* Adjust the Gamma Curve */
  170.         LCD::WriteReg(0x0030, 0x0000);
  171.         LCD::WriteReg(0x0031, 0x0106);
  172.         LCD::WriteReg(0x0032, 0x0000);
  173.         LCD::WriteReg(0x0035, 0x0204);
  174.         LCD::WriteReg(0x0036, 0x160A);
  175.         LCD::WriteReg(0x0037, 0x0707);
  176.         LCD::WriteReg(0x0038, 0x0106);
  177.         LCD::WriteReg(0x0039, 0x0707);
  178.         LCD::WriteReg(0x003C, 0x0402);
  179.         LCD::WriteReg(0x003D, 0x0C0F);
  180.         /* Set GRAM area */
  181.         LCD::WriteReg(0x0050, 0x0000);   /* Horizontal GRAM Start Address */
  182.         LCD::WriteReg(0x0051, 0x00EF);   /* Horizontal GRAM End Address */
  183.         LCD::WriteReg(0x0052, 0x0000);   /* Vertical GRAM Start Address */
  184.         LCD::WriteReg(0x0053, 0x013F);   /* Vertical GRAM Start Address */
  185.         LCD::WriteReg(0x0060, 0x2700);   /* Gate Scan Line */
  186.         LCD::WriteReg(0x0061, 0x0001);   /*  NDL,VLE, REV */
  187.         LCD::WriteReg(0x006A, 0x0000);   /* set scrolling line */
  188.         /* Partial Display Control */
  189.         LCD::WriteReg(0x0080, 0x0000);
  190.         LCD::WriteReg(0x0081, 0x0000);
  191.         LCD::WriteReg(0x0082, 0x0000);
  192.         LCD::WriteReg(0x0083, 0x0000);
  193.         LCD::WriteReg(0x0084, 0x0000);
  194.         LCD::WriteReg(0x0085, 0x0000);
  195.         /* Panel Control */
  196.         LCD::WriteReg(0x0090, 0x0010);
  197.         LCD::WriteReg(0x0092, 0x0600);
  198.         LCD::WriteReg(0x0007,0x0021);
  199.         LCD::Inner_delay(50);                   /* delay 50 ms */
  200.         LCD::WriteReg(0x0007,0x0061);
  201.         LCD::Inner_delay(50);                   /* delay 50 ms */
  202.         LCD::WriteReg(0x0007,0x0133);    /* 262K color and display ON */
  203.         LCD::Inner_delay(50);                   /* delay 50 ms */
  204.     }
  205.     else if(LCD_DeviceCode==0x9919)
  206.     {
  207.         /* POWER ON &RESET DISPLAY OFF */
  208.         LCD::WriteReg(0x28,0x0006);
  209.         LCD::WriteReg(0x00,0x0001);
  210.         LCD::WriteReg(0x10,0x0000);
  211.         LCD::WriteReg(0x01,0x72ef);
  212.         LCD::WriteReg(0x02,0x0600);
  213.         LCD::WriteReg(0x03,0x6a38);
  214.         LCD::WriteReg(0x11,0x6874);
  215.         LCD::WriteReg(0x0f,0x0000);    /* RAM WRITE DATA MASK */
  216.         LCD::WriteReg(0x0b,0x5308);    /* RAM WRITE DATA MASK */
  217.         LCD::WriteReg(0x0c,0x0003);
  218.         LCD::WriteReg(0x0d,0x000a);
  219.         LCD::WriteReg(0x0e,0x2e00);
  220.         LCD::WriteReg(0x1e,0x00be);
  221.         LCD::WriteReg(0x25,0x8000);
  222.         LCD::WriteReg(0x26,0x7800);
  223.         LCD::WriteReg(0x27,0x0078);
  224.         LCD::WriteReg(0x4e,0x0000);
  225.         LCD::WriteReg(0x4f,0x0000);
  226.         LCD::WriteReg(0x12,0x08d9);
  227.         /* Adjust the Gamma Curve */
  228.         LCD::WriteReg(0x30,0x0000);
  229.         LCD::WriteReg(0x31,0x0104);
  230.         LCD::WriteReg(0x32,0x0100);
  231.         LCD::WriteReg(0x33,0x0305);
  232.         LCD::WriteReg(0x34,0x0505);
  233.         LCD::WriteReg(0x35,0x0305);
  234.         LCD::WriteReg(0x36,0x0707);
  235.         LCD::WriteReg(0x37,0x0300);
  236.         LCD::WriteReg(0x3a,0x1200);
  237.         LCD::WriteReg(0x3b,0x0800);
  238.         LCD::WriteReg(0x07,0x0033);
  239.     }
  240.     else if(LCD_DeviceCode==0x1505)
  241.     {
  242.         /* second release on 3/5  ,luminance is acceptable,water wave appear during camera preview */
  243.         LCD::WriteReg(0x0007,0x0000);
  244.         LCD::Inner_delay(50);                   /* delay 50 ms */
  245.         LCD::WriteReg(0x0012,0x011C);    /* why need to set several times?  */
  246.         LCD::WriteReg(0x00A4,0x0001);    /* NVM */
  247.         LCD::WriteReg(0x0008,0x000F);
  248.         LCD::WriteReg(0x000A,0x0008);
  249.         LCD::WriteReg(0x000D,0x0008);
  250.         /* GAMMA CONTROL */
  251.         LCD::WriteReg(0x0030,0x0707);
  252.         LCD::WriteReg(0x0031,0x0007);
  253.         LCD::WriteReg(0x0032,0x0603);
  254.         LCD::WriteReg(0x0033,0x0700);
  255.         LCD::WriteReg(0x0034,0x0202);
  256.         LCD::WriteReg(0x0035,0x0002);
  257.         LCD::WriteReg(0x0036,0x1F0F);
  258.         LCD::WriteReg(0x0037,0x0707);
  259.         LCD::WriteReg(0x0038,0x0000);
  260.         LCD::WriteReg(0x0039,0x0000);
  261.         LCD::WriteReg(0x003A,0x0707);
  262.         LCD::WriteReg(0x003B,0x0000);
  263.         LCD::WriteReg(0x003C,0x0007);
  264.         LCD::WriteReg(0x003D,0x0000);
  265.         LCD::Inner_delay(50);                   /* delay 50 ms */
  266.         LCD::WriteReg(0x0007,0x0001);
  267.         LCD::WriteReg(0x0017,0x0001);    /* Power supply startup enable */
  268.         LCD::Inner_delay(50);                   /* delay 50 ms */
  269.         /* power control */
  270.         LCD::WriteReg(0x0010,0x17A0);
  271.         LCD::WriteReg(0x0011,0x0217);    /* reference voltage VC[2:0]   Vciout = 1.00*Vcivl */
  272.         LCD::WriteReg(0x0012,0x011E);    /* Vreg1out = Vcilvl*1.80   is it the same as Vgama1out ?  */
  273.         LCD::WriteReg(0x0013,0x0F00);    /* VDV[4:0]-->VCOM Amplitude VcomL = VcomH - Vcom Ampl */
  274.         LCD::WriteReg(0x002A,0x0000);
  275.         LCD::WriteReg(0x0029,0x000A);    /* Vcomh = VCM1[4:0]*Vreg1out    gate source voltage?? */
  276.         LCD::WriteReg(0x0012,0x013E);    /* power supply on */
  277.         /* Coordinates Control */
  278.         LCD::WriteReg(0x0050,0x0000);
  279.         LCD::WriteReg(0x0051,0x00EF);
  280.         LCD::WriteReg(0x0052,0x0000);
  281.         LCD::WriteReg(0x0053,0x013F);
  282.         /* Pannel Image Control */
  283.         LCD::WriteReg(0x0060,0x2700);
  284.         LCD::WriteReg(0x0061,0x0001);
  285.         LCD::WriteReg(0x006A,0x0000);
  286.         LCD::WriteReg(0x0080,0x0000);
  287.         /* Partial Image Control */
  288.         LCD::WriteReg(0x0081,0x0000);
  289.         LCD::WriteReg(0x0082,0x0000);
  290.         LCD::WriteReg(0x0083,0x0000);
  291.         LCD::WriteReg(0x0084,0x0000);
  292.         LCD::WriteReg(0x0085,0x0000);
  293.         /* Panel Interface Control */
  294.         LCD::WriteReg(0x0090,0x0013);      /* frenqucy */
  295.         LCD::WriteReg(0x0092,0x0300);
  296.         LCD::WriteReg(0x0093,0x0005);
  297.         LCD::WriteReg(0x0095,0x0000);
  298.         LCD::WriteReg(0x0097,0x0000);
  299.         LCD::WriteReg(0x0098,0x0000);
  300.  
  301.         LCD::WriteReg(0x0001,0x0100);
  302.         LCD::WriteReg(0x0002,0x0700);
  303.         LCD::WriteReg(0x0003,0x1030);
  304.         LCD::WriteReg(0x0004,0x0000);
  305.         LCD::WriteReg(0x000C,0x0000);
  306.         LCD::WriteReg(0x000F,0x0000);
  307.         LCD::WriteReg(0x0020,0x0000);
  308.         LCD::WriteReg(0x0021,0x0000);
  309.         LCD::WriteReg(0x0007,0x0021);
  310.         LCD::Inner_delay(200);                   /* delay 200 ms */
  311.         LCD::WriteReg(0x0007,0x0061);
  312.         LCD::Inner_delay(200);                   /* delay 200 ms */
  313.         LCD::WriteReg(0x0007,0x0173);
  314.         LCD::Inner_delay(200);                   /* delay 200 ms */
  315.     }
  316.     else if(LCD_DeviceCode==0x8989)
  317.     {
  318.         LCD::WriteReg(0x0000,0x0001);    LCD::Inner_delay(50);
  319.         LCD::WriteReg(0x0003,0xA8A4);    LCD::Inner_delay(50);
  320.         LCD::WriteReg(0x000C,0x0000);    LCD::Inner_delay(50);
  321.         LCD::WriteReg(0x000D,0x080C);    LCD::Inner_delay(50);
  322.         LCD::WriteReg(0x000E,0x2B00);    LCD::Inner_delay(50);
  323.         LCD::WriteReg(0x001E,0x00B0);    LCD::Inner_delay(50);
  324.         LCD::WriteReg(0x0001,0x2B3F);    LCD::Inner_delay(50);
  325.         LCD::WriteReg(0x0002,0x0600);    LCD::Inner_delay(50);
  326.         LCD::WriteReg(0x0010,0x0000);    LCD::Inner_delay(50);
  327.         LCD::WriteReg(0x0011,0x6070);    LCD::Inner_delay(50);
  328.         LCD::WriteReg(0x0005,0x0000);    LCD::Inner_delay(50);
  329.         LCD::WriteReg(0x0006,0x0000);    LCD::Inner_delay(50);
  330.         LCD::WriteReg(0x0016,0xEF1C);    LCD::Inner_delay(50);
  331.         LCD::WriteReg(0x0017,0x0003);    LCD::Inner_delay(50);
  332.         LCD::WriteReg(0x0007,0x0133);    LCD::Inner_delay(50);
  333.         LCD::WriteReg(0x000B,0x0000);    LCD::Inner_delay(50);
  334.         LCD::WriteReg(0x000F,0x0000);    LCD::Inner_delay(50);
  335.         LCD::WriteReg(0x0041,0x0000);    LCD::Inner_delay(50);
  336.         LCD::WriteReg(0x0042,0x0000);    LCD::Inner_delay(50);
  337.         LCD::WriteReg(0x0048,0x0000);    LCD::Inner_delay(50);
  338.         LCD::WriteReg(0x0049,0x013F);    LCD::Inner_delay(50);
  339.         LCD::WriteReg(0x004A,0x0000);    LCD::Inner_delay(50);
  340.         LCD::WriteReg(0x004B,0x0000);    LCD::Inner_delay(50);
  341.         LCD::WriteReg(0x0044,0xEF00);    LCD::Inner_delay(50);
  342.         LCD::WriteReg(0x0045,0x0000);    LCD::Inner_delay(50);
  343.         LCD::WriteReg(0x0046,0x013F);    LCD::Inner_delay(50);
  344.         LCD::WriteReg(0x0030,0x0707);    LCD::Inner_delay(50);
  345.         LCD::WriteReg(0x0031,0x0204);    LCD::Inner_delay(50);
  346.         LCD::WriteReg(0x0032,0x0204);    LCD::Inner_delay(50);
  347.         LCD::WriteReg(0x0033,0x0502);    LCD::Inner_delay(50);
  348.         LCD::WriteReg(0x0034,0x0507);    LCD::Inner_delay(50);
  349.         LCD::WriteReg(0x0035,0x0204);    LCD::Inner_delay(50);
  350.         LCD::WriteReg(0x0036,0x0204);    LCD::Inner_delay(50);
  351.         LCD::WriteReg(0x0037,0x0502);    LCD::Inner_delay(50);
  352.         LCD::WriteReg(0x003A,0x0302);    LCD::Inner_delay(50);
  353.         LCD::WriteReg(0x003B,0x0302);    LCD::Inner_delay(50);
  354.         LCD::WriteReg(0x0023,0x0000);    LCD::Inner_delay(50);
  355.         LCD::WriteReg(0x0024,0x0000);    LCD::Inner_delay(50);
  356.         LCD::WriteReg(0x0025,0x8000);    LCD::Inner_delay(50);
  357.         LCD::WriteReg(0x004f,0);
  358.         LCD::WriteReg(0x004e,0);
  359.     }
  360.     LCD::Inner_delay(50);  /* delay 50 ms */
  361.  
  362. //  LCD::BackLight_Init();
  363.     LCD::Clear(Black);
  364.  
  365.  
  366. }
  367.  
  368. bool LCD::BackLight(uint8_t percent) {
  369.     if( percent >= 0 && percent <= 100)
  370.     {
  371.         analogWrite(BL_Pin,percent * 655);
  372.         return true;
  373.     }
  374.     else
  375.         return false;
  376. }
  377.  
  378. void LCD::BackLight_Init(void) {
  379.  
  380.     pinMode(BL_Pin,PWM);
  381.  
  382.     afio_remap(AFIO_REMAP_TIM3_PARTIAL);
  383.  
  384.     analogWrite(BL_Pin,0xFFFF);
  385.  
  386. }
  387.  
  388. uint16_t LCD::BGR2RGB(uint16_t color) {
  389.     uint16_t  r, g, b, rgb;
  390.  
  391.     b = ( color>>0 )  & 0x1f;
  392.     g = ( color>>5 )  & 0x3f;
  393.     r = ( color>>11 ) & 0x1f;
  394.  
  395.     rgb =  (b<<11) + (g<<5) + (r<<0);
  396.  
  397.     return( rgb );
  398. }
  399.  
  400.  
  401.  
  402. void LCD::Clear(uint16_t Color) {
  403.  
  404.     uint32_t in;
  405.  
  406.     // Set cursor to 0,0
  407.     LCD_REG = 0x4e;
  408.     LCD_RAM = 0;
  409.  
  410.     LCD_REG = 0x4f;
  411.     LCD_RAM = 0;
  412.  
  413.     // Prepare to write di GRAM
  414.     LCD_REG = R34;
  415.  
  416.     for(in=0;in<76800;in++)
  417.     {
  418.         LCD_RAM=Color;
  419.     }
  420. }
  421.  
  422. void LCD::DrawLine(int x1, int y1, int x2, int y2,uint16_t bkColor) {
  423.     int x,y,dx,dy,Dx,Dy,e,i;
  424.     Dx=x2-x1;
  425.     Dy=y2-y1;
  426.  
  427.     dx=fabs(x2-x1);
  428.     dy=fabs(y2-y1);
  429.     x=x1;
  430.     y=y1;
  431.     if(dy>dx)
  432.     {
  433.         e=-dy;
  434.         for(i=0;i<dy;i++)
  435.         {
  436.             LCD::SetPoint(x,y,bkColor);
  437.             if(Dy>=0) y++;
  438.             else y--;
  439.             e+=2*dx;
  440.             if(e>=0)
  441.             {
  442.                 if(Dx>=0) x++;
  443.                 else x--;
  444.                 e-=2*dy;
  445.             }
  446.         }
  447.     }
  448.     else
  449.     {
  450.         e=-dx;
  451.         for(i=0;i<dx;i++)
  452.         {
  453.             LCD::SetPoint(x,y,bkColor);
  454.             if(Dx>=0) x++;
  455.             else x--;
  456.             e+=2*dy;
  457.             if(e>=0)
  458.             {
  459.                 if(Dy>=0) y++;
  460.                 else y--;
  461.                 e-=2*dx;
  462.             }
  463.         }
  464.     }
  465. }
  466.  
  467. void LCD::DrawPicture(uint16_t StartX,uint16_t StartY,uint16_t EndX,uint16_t EndY,uint16_t *pic) {
  468.     uint16_t  i;
  469.     LCD::SetCursor(StartX,StartY);
  470.     LCD::WriteRAM_Prepare();
  471.     for (i=0;i<(EndX*EndY);i++)
  472.     {
  473.         LCD::WriteRAM(*pic++);
  474.     }
  475. }
  476.  
  477. void LCD::FSMCConfig(void) {
  478.  
  479.     fsmc_nor_psram_reg_map *regs = FSMC_NOR_PSRAM1_BASE;
  480.     uint32_t* extended = (uint32_t*) 0xA0000000 + 0x104;
  481.  
  482.     fsmc_sram_init_gpios();
  483.     rcc_clk_enable(RCC_FSMC);
  484.  
  485.  
  486.     regs->BCR = (uint32_t)0x00000000 | //FSMC_DataAddressMux_Disable
  487.                 (uint32_t)0x00000000 | //FSMC_MemoryType_SRAM
  488.                 (uint32_t)0x00000010 | //FSMC_MemoryDataWidth_16b
  489.                 (uint32_t)0x00000000 | //FSMC_BurstAccessMode_Disable
  490.                 (uint32_t)0x00000000 | //FSMC_WaitSignalPolarity_Low
  491.                 (uint32_t)0x00000000 | //FSMC_WrapMode_Disable
  492.                 (uint32_t)0x00000000 | //FSMC_WaitSignalActive_BeforeWaitState
  493.                 (uint32_t)0x00001000 | //FSMC_WriteOperation_Enable
  494.                 (uint32_t)0x00000000 | //FSMC_WaitSignal_Disable
  495.                 (uint32_t)0x00000000 | //FSMC_AsynchronousWait_Disable
  496.                 (uint32_t)0x00000000 | //FSMC_ExtendedMode_Disable
  497.                 (uint32_t)0x00000000;  //FSMC_WriteBurst_Disable
  498.  
  499.     regs->BCR |= (uint32_t)0x00000040; //BCR_FACCEN_Set
  500.                
  501.     regs->BTR = (uint32_t) 3    | //FSMC_AddressSetupTime
  502.                 0 << 4          | //FSMC_AddressHoldTime
  503.                 3 << 8          | //FSMC_DataSetupTime
  504.                 0 << 16         | //FSMC_BusTurnAroundDuration
  505.                 0 << 20         | //FSMC_CLKDivision
  506.                 0 << 24         | //FSMC_DataLatency
  507.                 0;                //FSMC_AccessMode_A
  508.                
  509.     *(extended) = 0x0FFFFFFF;
  510.  
  511.     regs->BCR |= (uint32_t)0x00000001; //BCR_MBKEN_Set
  512.  
  513.  
  514. //    FSMC_NORSRAMInitTypeDef  FSMC_NORSRAMInitStructure;
  515. //    FSMC_NORSRAMTimingInitTypeDef FSMC_NORSRAMTimingInitStructure;
  516.  
  517. //    FSMC_NORSRAMTimingInitStructure.FSMC_AddressSetupTime = 10;
  518. //    FSMC_NORSRAMTimingInitStructure.FSMC_AddressHoldTime = 0;
  519. //    FSMC_NORSRAMTimingInitStructure.FSMC_DataSetupTime = 10;
  520. //    FSMC_NORSRAMTimingInitStructure.FSMC_BusTurnAroundDuration = 0x00;
  521. //    FSMC_NORSRAMTimingInitStructure.FSMC_CLKDivision = 0x00;
  522. //    FSMC_NORSRAMTimingInitStructure.FSMC_DataLatency = 0x00;
  523. //    FSMC_NORSRAMTimingInitStructure.FSMC_AccessMode = FSMC_AccessMode_A;
  524. //
  525. //    FSMC_NORSRAMInitStructure.FSMC_Bank = FSMC_Bank1_NORSRAM1;
  526. //    FSMC_NORSRAMInitStructure.FSMC_DataAddressMux = FSMC_DataAddressMux_Disable;
  527. //    FSMC_NORSRAMInitStructure.FSMC_MemoryType = FSMC_MemoryType_SRAM;
  528. //    FSMC_NORSRAMInitStructure.FSMC_MemoryDataWidth = FSMC_MemoryDataWidth_16b;
  529. //    FSMC_NORSRAMInitStructure.FSMC_BurstAccessMode = FSMC_BurstAccessMode_Disable;
  530. //    FSMC_NORSRAMInitStructure.FSMC_WaitSignalPolarity = FSMC_WaitSignalPolarity_Low;
  531. //    FSMC_NORSRAMInitStructure.FSMC_WrapMode = FSMC_WrapMode_Disable;
  532. //    FSMC_NORSRAMInitStructure.FSMC_WaitSignalActive = FSMC_WaitSignalActive_BeforeWaitState;
  533. //    FSMC_NORSRAMInitStructure.FSMC_WriteOperation = FSMC_WriteOperation_Enable;
  534. //    FSMC_NORSRAMInitStructure.FSMC_WaitSignal = FSMC_WaitSignal_Disable;
  535. //    FSMC_NORSRAMInitStructure.FSMC_AsynchronousWait = FSMC_AsynchronousWait_Disable;
  536. //    FSMC_NORSRAMInitStructure.FSMC_ExtendedMode = FSMC_ExtendedMode_Disable;
  537. //    FSMC_NORSRAMInitStructure.FSMC_WriteBurst = FSMC_WriteBurst_Disable;
  538. //    FSMC_NORSRAMInitStructure.FSMC_ReadWriteTimingStruct = &FSMC_NORSRAMTimingInitStructure;
  539. //    FSMC_NORSRAMInit(&FSMC_NORSRAMInitStructure);
  540.  
  541. //    FSMC_NORSRAMTimingInitStructure.FSMC_AddressSetupTime = 3;
  542. //    FSMC_NORSRAMTimingInitStructure.FSMC_AddressHoldTime = 0;
  543. //    FSMC_NORSRAMTimingInitStructure.FSMC_DataSetupTime = 3;
  544. //    FSMC_NORSRAMTimingInitStructure.FSMC_BusTurnAroundDuration = 0x00;
  545. //    FSMC_NORSRAMTimingInitStructure.FSMC_CLKDivision = 0x00;
  546. //    FSMC_NORSRAMTimingInitStructure.FSMC_DataLatency = 0x00;
  547. //    FSMC_NORSRAMTimingInitStructure.FSMC_AccessMode = FSMC_AccessMode_A;
  548. //    FSMC_NORSRAMInitStructure.FSMC_WriteTimingStruct = &FSMC_NORSRAMTimingInitStructure;
  549. //
  550. //    FSMC_NORSRAMInit(&FSMC_NORSRAMInitStructure);
  551. //
  552. //    /* Enable FSMC Bank1_SRAM Bank */
  553. //    FSMC_NORSRAMCmd(FSMC_Bank1_NORSRAM1, ENABLE);
  554. }
  555.  
  556. uint16_t LCD::GetPoint(uint16_t Xpos,uint16_t Ypos) {
  557.     LCD::SetCursor(Xpos,Ypos);
  558.     return ( LCD::BGR2RGB(LCD::ReadRAM()) );
  559. }
  560.  
  561. uint16_t LCD::ReadRAM(void) {
  562.     /* Write 16-bit Index (then Read Reg) */
  563.     LCD_REG = R34; /* Select GRAM Reg */
  564.     /* Read 16-bit Reg */
  565.     return LCD_RAM;
  566. }
  567.  
  568. uint16_t LCD::ReadReg(uint8_t LCD_Reg) {
  569.     /* Write 16-bit Index (then Read Reg) */
  570.     LCD_REG = LCD_Reg;
  571.     /* Read 16-bit Reg */
  572.  
  573.     return (LCD_RAM);
  574. }
  575.  
  576. void LCD::SetCursor(uint16_t Xpos,uint16_t Ypos) {
  577.     if(LCD_DeviceCode==0x8989)
  578.     {
  579.         LCD::WriteReg(0x004e,Xpos); /* Row */
  580.         LCD::WriteReg(0x004f,Ypos); /* Line */
  581.     }
  582.     else if(LCD_DeviceCode==0x9919)
  583.     {
  584.         LCD::WriteReg(0x004e,Xpos); /* Row */
  585.         LCD::WriteReg(0x004f,Ypos); /* Line */
  586.     }
  587.     else
  588.     {
  589.         LCD::WriteReg(0x0020,Xpos); /* Row */
  590.         LCD::WriteReg(0x0021,Ypos); /* Line */
  591.     }
  592. }
  593.  
  594. void LCD::SetPoint(uint16_t Xpos,uint16_t Ypos,uint16_t point) {
  595.     LCD::SetCursor(Xpos,Ypos);
  596.     LCD::WriteRAM_Prepare();
  597.     LCD::WriteRAM(point);
  598. }
  599.  
  600. void LCD::SetWindows(uint16_t xStart,uint16_t yStart,uint16_t xLong,uint16_t yLong) {
  601.     LCD::SetCursor(xStart,yStart);
  602.     LCD::WriteReg(0x0050,xStart);
  603.     LCD::WriteReg(0x0051,xStart+xLong-1);
  604.     LCD::WriteReg(0x0052,yStart);
  605.     LCD::WriteReg(0x0053,yStart+yLong-1);
  606. }
  607.  
  608. void LCD::WriteRAM(uint16_t RGB_Code) {
  609.     /* Write 16-bit GRAM Reg */
  610.     LCD_RAM = RGB_Code;
  611. }
  612.  
  613. void LCD::WriteRAM_Prepare(void) {
  614.     LCD_REG = R34;
  615. }
  616.  
  617. void LCD::WriteReg(uint8_t LCD_Reg,uint16_t LCD_RegValue) {
  618.     /* Write 16-bit Index, then Write Reg */
  619.     LCD_REG = LCD_Reg;
  620.     /* Write 16-bit Reg */
  621.     LCD_RAM = LCD_RegValue;
  622. }
  623.  
  624. void LCD::WriteText(uint16_t Xpos, uint16_t Ypos, char *str,uint16_t Color, uint16_t bkColor) {
  625.     uint8_t TempChar;
  626.     do
  627.     {
  628.         TempChar=*str++;
  629.         PutChar(Xpos,Ypos,TempChar,Color,bkColor);
  630.         if (Xpos<232)
  631.         {
  632.             Xpos+=8;
  633.         }
  634.         else if (Ypos<304)
  635.         {
  636.             Xpos=0;
  637.             Ypos+=16;
  638.         }
  639.         else
  640.         {
  641.             Xpos=0;
  642.             Ypos=0;
  643.         }
  644.     }
  645.     while (*str!=0);
  646. }
  647.  
  648. void LCD::PutChar(unsigned short Xpos,unsigned short Ypos,unsigned char c,unsigned short charColor,unsigned short bkColor) {
  649.     unsigned short i=0;
  650.     unsigned short j=0;
  651.     unsigned char buffer[16];
  652.     unsigned char tmp_char=0;
  653.     GetASCIICode(buffer,c);
  654.     for (i=0;i<16;i++) {
  655.  
  656.         tmp_char=buffer[i];
  657.  
  658.         for (j=0;j<8;j++) {
  659.             if ( (tmp_char >> (7-j)) & (0x01 == 0x01))
  660.             {
  661.                 LCD::SetPoint(Xpos+j,Ypos+i,charColor);
  662.             }
  663.             else
  664.             {
  665.                 LCD::SetPoint(Xpos+j,Ypos+i,bkColor);
  666.             }
  667.         }
  668.     }
  669. }
  670.  
  671. void LCD::Inner_delay(uint8_t t) {
  672.     delay(t);
  673. }
Advertisement
Add Comment
Please, Sign In to add comment
Public Pastes
We use cookies for various purposes including analytics. By continuing to use Pastebin, you agree to our use of cookies as described in the Cookies Policy.  OK, I Understand
Not a member of Pastebin yet?
Sign Up, it unlocks many cool features!