Imayan chan / S6D0151

for TFT2P0327 aitendo.com 128*160 TFT LCD. LCD driver is S6D0151 Sumsung.

Dependents:   FRDM_tocos_x2_FIXED

S6D0151_TFT.cpp@5:18920a7a693e, 2016-10-02 (annotated)

Committer:
king33jp
Date:
Sun Oct 02 13:20:50 2016 +0000
Revision:
5:18920a7a693e
Parent:
4:648a364412e4 
all change fixed.; rectfill modify; reverse fix; and; orientation command added.; onley 0 and 2 is valid.

Who changed what in which revision?

UserRevisionLine numberNew contents of line
king33jp 1:a3651128e297 1 /* mbed library for 128*160 pixel display TFT based on S6D0151 LCD Controller
king33jp 1:a3651128e297 2 *
king33jp 1:a3651128e297 3 */
king33jp 0:de7db46990d0 4
king33jp 0:de7db46990d0 5 #include "S6D0151_TFT.h"
king33jp 0:de7db46990d0 6 #include "mbed.h"
king33jp 0:de7db46990d0 7
king33jp 0:de7db46990d0 8 #define BPP 16 // Bits per pixel
king33jp 0:de7db46990d0 9
king33jp 0:de7db46990d0 10 S6D0151_TFT::S6D0151_TFT(PinName mosi, PinName miso, PinName sclk, PinName cs, PinName reset, const char *name)
king33jp 0:de7db46990d0 11 : _spi(mosi, miso, sclk), _cs(cs), _reset(reset),GraphicsDisplay(name) {
king33jp 0:de7db46990d0 12 tft_reset();
king33jp 4:648a364412e4 13 orientation = 0;
king33jp 0:de7db46990d0 14 char_x = 0;
king33jp 0:de7db46990d0 15 }
king33jp 0:de7db46990d0 16
king33jp 0:de7db46990d0 17
king33jp 0:de7db46990d0 18 int S6D0151_TFT::width() {
king33jp 0:de7db46990d0 19 if (orientation == 0 || orientation == 2) return 128;
king33jp 0:de7db46990d0 20 else return 160;
king33jp 0:de7db46990d0 21 }
king33jp 0:de7db46990d0 22
king33jp 0:de7db46990d0 23
king33jp 0:de7db46990d0 24 int S6D0151_TFT::height() {
king33jp 0:de7db46990d0 25 if (orientation == 0 || orientation == 2) return 160;
king33jp 0:de7db46990d0 26 else return 128;
king33jp 0:de7db46990d0 27 }
king33jp 0:de7db46990d0 28
king33jp 0:de7db46990d0 29
king33jp 0:de7db46990d0 30 void S6D0151_TFT::set_orientation(unsigned int o) {
king33jp 0:de7db46990d0 31 orientation = o;
king33jp 4:648a364412e4 32 /* I can't understand rotation methods.
king33jp 4:648a364412e4 33 Maybe , S6D0151 can NOT conversion row and column.
king33jp 4:648a364412e4 34 but i can conversion up and down.
king33jp 4:648a364412e4 35 orientation=0 : Normal FPC side bottom.
king33jp 4:648a364412e4 36 orientation=2 ; Reverse FPC side is Top.
king33jp 4:648a364412e4 37 */
king33jp 0:de7db46990d0 38 switch (orientation) {
king33jp 0:de7db46990d0 39 case 0:
king33jp 4:648a364412e4 40 regwr(0x0001,0x0014); //DRIVER OUTPUT CONTROL (R01h)
king33jp 0:de7db46990d0 41 break;
king33jp 0:de7db46990d0 42 case 1:
king33jp 4:648a364412e4 43 //wr_reg(ST7735_MADCTL, 0x0060);
king33jp 0:de7db46990d0 44 break;
king33jp 0:de7db46990d0 45 case 2:
king33jp 4:648a364412e4 46 regwr(0x0001,0x0314); //DRIVER OUTPUT CONTROL (R01h)
king33jp 0:de7db46990d0 47 break;
king33jp 0:de7db46990d0 48 case 3:
king33jp 4:648a364412e4 49 //wr_reg(ST7735_MADCTL, 0x00A0);
king33jp 0:de7db46990d0 50 break;
king33jp 0:de7db46990d0 51 }
king33jp 0:de7db46990d0 52 }
king33jp 0:de7db46990d0 53
king33jp 0:de7db46990d0 54 void S6D0151_TFT::wr_dat_start(void) {
king33jp 0:de7db46990d0 55 // _rs = 1; // rs high, cs low for transmitting data
king33jp 0:de7db46990d0 56 _cs = 0;
king33jp 0:de7db46990d0 57 _spi.write( 0x72 ); // Start byte
king33jp 0:de7db46990d0 58 }
king33jp 0:de7db46990d0 59
king33jp 0:de7db46990d0 60
king33jp 0:de7db46990d0 61
king33jp 0:de7db46990d0 62 void S6D0151_TFT::wr_dat_stop (void) {
king33jp 0:de7db46990d0 63 _cs = 1;
king33jp 0:de7db46990d0 64 }
king33jp 0:de7db46990d0 65
king33jp 0:de7db46990d0 66
king33jp 0:de7db46990d0 67 void S6D0151_TFT::set_start_address(int left,int top){
king33jp 0:de7db46990d0 68 unsigned short addr;
king33jp 0:de7db46990d0 69 addr = (((top&0xff)<<8)|(left&0xff));
king33jp 0:de7db46990d0 70
king33jp 0:de7db46990d0 71 regwr( 0x0021 , addr );
king33jp 0:de7db46990d0 72 }
king33jp 0:de7db46990d0 73
king33jp 5:18920a7a693e 74 void S6D0151_TFT::reverse(int rev){
king33jp 5:18920a7a693e 75 if(rev == TFT_REVERSE_ON){
king33jp 5:18920a7a693e 76 regwr(0x0007,0x0033); //DISPLAY CONTROL (R07h)
king33jp 5:18920a7a693e 77 } else {
king33jp 5:18920a7a693e 78 regwr(0x0007,0x0037); //DISPLAY CONTROL (R07h)
king33jp 5:18920a7a693e 79 }
king33jp 5:18920a7a693e 80 // X X X PT1 PT0 X X SPT X X GON DTE CL REV D1 D0
king33jp 5:18920a7a693e 81 //GON=1,DTE=1 VGH/VGL Normal operation
king33jp 5:18920a7a693e 82 //Rev bit mean Color reverse.
king33jp 5:18920a7a693e 83 //REV=1 Displays all character and graphics display sections with Reverse
king33jp 5:18920a7a693e 84 //D[1:0]=11 Display is RAM data
king33jp 5:18920a7a693e 85 }
king33jp 0:de7db46990d0 86
king33jp 0:de7db46990d0 87 /**
king33jp 0:de7db46990d0 88 */
king33jp 0:de7db46990d0 89 void S6D0151_TFT::regwr(unsigned short reg,unsigned short dat){
king33jp 0:de7db46990d0 90 int data;
king33jp 0:de7db46990d0 91 _cs = 0;
king33jp 0:de7db46990d0 92 _spi.write(0x70); // RW=0,ID=0,RS=0(Index Register write)
king33jp 0:de7db46990d0 93 data = (reg>>8)&0x00ff;
king33jp 0:de7db46990d0 94 _spi.write( data );
king33jp 0:de7db46990d0 95 data = (reg )&0x00ff;
king33jp 0:de7db46990d0 96 _spi.write( data );
king33jp 0:de7db46990d0 97 _cs = 1;
king33jp 1:a3651128e297 98 wait_us(1); // cs=high Time has not been defined.
king33jp 0:de7db46990d0 99 _cs = 0;
king33jp 0:de7db46990d0 100 _spi.write(0x72); // RW=0,ID=0,RS=1(data write)
king33jp 0:de7db46990d0 101 data = (dat>>8)&0x00ff;
king33jp 0:de7db46990d0 102 _spi.write( data );
king33jp 0:de7db46990d0 103 data = (dat )&0x00ff;
king33jp 0:de7db46990d0 104 _spi.write( data );
king33jp 0:de7db46990d0 105 _cs = 1;
king33jp 0:de7db46990d0 106 }
king33jp 0:de7db46990d0 107 void S6D0151_TFT::reg0(unsigned short reg){
king33jp 0:de7db46990d0 108 int data;
king33jp 0:de7db46990d0 109 _cs = 0;
king33jp 0:de7db46990d0 110 _spi.write(0x70); // RW=0,ID=0,RS=0(Index Register write)
king33jp 0:de7db46990d0 111 data = (reg>>8)&0x00ff;
king33jp 0:de7db46990d0 112 _spi.write( data );
king33jp 0:de7db46990d0 113 data = (reg )&0x00ff;
king33jp 0:de7db46990d0 114 _spi.write( data );
king33jp 0:de7db46990d0 115 _cs = 1;
king33jp 0:de7db46990d0 116 }
king33jp 0:de7db46990d0 117
king33jp 0:de7db46990d0 118 void S6D0151_TFT::tft_reset() {
king33jp 0:de7db46990d0 119 // init SPI
king33jp 0:de7db46990d0 120 _spi.format(8,3); // 8 bit spi mode 3
king33jp 1:a3651128e297 121 _spi.frequency(6000000); // 6Mhz SPI clock ... 10Mhz is maximum for display
king33jp 0:de7db46990d0 122
king33jp 0:de7db46990d0 123 _cs = 0;
king33jp 1:a3651128e297 124 _reset = 1;
king33jp 0:de7db46990d0 125 wait_ms(500);
king33jp 0:de7db46990d0 126 _reset = 0; // reset
king33jp 0:de7db46990d0 127 wait_ms(500);
king33jp 1:a3651128e297 128 _reset = 1;
king33jp 0:de7db46990d0 129 wait_ms(500);
king33jp 0:de7db46990d0 130
king33jp 0:de7db46990d0 131 /* Start Initial Sequence ----------------------------------------------------*/
king33jp 1:a3651128e297 132 /* follow code is aitendo demo-code...........................................*/
king33jp 1:a3651128e297 133 /* I have changed the part in the demo code to reference----------------------*/
king33jp 0:de7db46990d0 134 regwr(0x0007,0x0020); //DISPLAY CONTROL (R07h)
king33jp 0:de7db46990d0 135 // X X X PT1 PT0 X X SPT X X GON DTE CL REV D1 D0
king33jp 0:de7db46990d0 136 //PT[1:0]=00 V63/V0 Normal Drive
king33jp 0:de7db46990d0 137 //SPT=0 Split Screen Driving Function is Not performed
king33jp 0:de7db46990d0 138 //GON=1,DTE=0 Normal operation
king33jp 0:de7db46990d0 139 //CL=0 262,144 colors / 65,536 colors
king33jp 0:de7db46990d0 140 //REV=0 Displays all character and graphics display sections with Normal
king33jp 0:de7db46990d0 141 //D[1:0]=00 the internal display operation halts and the display is off.
king33jp 0:de7db46990d0 142
king33jp 0:de7db46990d0 143 regwr(0x00b6,0x013f); //Module Vendor (RB6h)
king33jp 0:de7db46990d0 144 // TEST_IN4 TEST_IN3 X X X X PSMD1(0) PSM D0(1) X X 1 1 1 1 1 1
king33jp 0:de7db46990d0 145 //TEST_IN4,TEST_IN3 User can know the Module Vendor through this register is accessed.
king33jp 0:de7db46990d0 146 //PSMD[1:0]=01 5680*(1/fosc) Select the power on time delay of step-up circuit.
king33jp 0:de7db46990d0 147
king33jp 0:de7db46990d0 148 regwr(0x00b4,0x0010); //MTP CONTROL (RB4h)
king33jp 0:de7db46990d0 149 // X X X MTP_SEL X X X MTP_INIT X X X MTP_WRB X X X MTP_LOAD
king33jp 0:de7db46990d0 150 //MTP_SEL=0 VCOMH Control Data is VCM Register
king33jp 0:de7db46990d0 151 //MTP_INIT=0
king33jp 0:de7db46990d0 152 //MTP_WRB=1 Cannot write MTP data
king33jp 0:de7db46990d0 153 //MTP_LOAD=0
king33jp 0:de7db46990d0 154
king33jp 0:de7db46990d0 155 regwr(0x0012,0x00b2); //POWER CONTROL 2 (R12h)
king33jp 0:de7db46990d0 156 // X X X X X X X X SVC3 SVC2 SVC1 SVC0 X 0 VRH5 VRH4
king33jp 0:de7db46990d0 157 //SVC Adjust reference voltage of AVDD, VGH, VGL and VCL
king33jp 0:de7db46990d0 158 // SVC[3:0]=1011 VCI1=2.76V
king33jp 0:de7db46990d0 159
king33jp 0:de7db46990d0 160 regwr(0x0013,0x080e); //POWER CONTROL 3 (R13h)
king33jp 0:de7db46990d0 161 // X X X X VCMR X X X X X X PON VRH3 VRH2 VRH1 VRH0
king33jp 0:de7db46990d0 162 //PON=0 The operational amplifier is stop.
king33jp 0:de7db46990d0 163 //VCMR=1 VCOMH voltage=Internal electronic volume
king33jp 0:de7db46990d0 164 //VRH[5:0]=1e=011110 VCIR_EXIN X 2.250 = 4.50V
king33jp 0:de7db46990d0 165
king33jp 0:de7db46990d0 166 regwr(0x0014,0x5bca); //POWER CONTROL 4 (R14h)
king33jp 0:de7db46990d0 167 // X VDV6 VDV5 VDV4 VDV3 VDV2 VDV1 VDV0 VCOMG VCM6 VCM5 VCM4 VCM3 VCM2 VCM1 VCM0
king33jp 0:de7db46990d0 168 //VDV Set the alternating amplitudes of Vcom at the Vcom alternating drive.
king33jp 0:de7db46990d0 169 // VDV[6:0]=5b=1011011 GVDD x 0.984
king33jp 0:de7db46990d0 170 //VCOMG=1 VcomL voltage can output to negative voltage.
king33jp 0:de7db46990d0 171 //Set the VcomH voltage (a high-level voltage at the Vcom alternating drive).
king33jp 0:de7db46990d0 172 // VCM[6:0]=1001010 GVDD x 0.8085
king33jp 0:de7db46990d0 173
king33jp 0:de7db46990d0 174 regwr(0x0061,0x0018); //OSCILLATOR CONTROL (R61h)
king33jp 0:de7db46990d0 175 // X X X X X X X X X X X RADJ4 RADJ3 RADJ2 RADJ1 RADJ0
king33jp 0:de7db46990d0 176 //RADJ[4:0]=11000 Oscillation Speed=x 1.000 Default
king33jp 0:de7db46990d0 177
king33jp 0:de7db46990d0 178 regwr(0x0010,0x190c); //POWER CONTROL 1 (R10h)
king33jp 0:de7db46990d0 179 // DSTB X SAP2 SAP1 SAP0 BT2 BT1 BT0 DC2 DC1 DC0 AP2 AP1 AP0 SLP STB
king33jp 0:de7db46990d0 180 //DSTB=0 Noraml
king33jp 0:de7db46990d0 181 //Adjust the slew-rate of the operational amplifier for the source driver.
king33jp 0:de7db46990d0 182 // SAP[2:0]=011 Medium Medium
king33jp 0:de7db46990d0 183 //BT[2:0]=001 VGH=AVDDx3 VGL=-(AVDDx2) VGH = Vci1 X six times
king33jp 0:de7db46990d0 184 //DC[2:0]=000 AVDD,VCL=DCCLK/1 VGH,VGL=DCCLK/2
king33jp 0:de7db46990d0 185 //AP[2:0]=011 Amount of Current in Operational Amplifier=Medium
king33jp 0:de7db46990d0 186 //SLP=0 setting Sleep. Normal mode
king33jp 0:de7db46990d0 187 //STB=0 setting standby. normal mode
king33jp 0:de7db46990d0 188 wait_ms(80);
king33jp 0:de7db46990d0 189
king33jp 0:de7db46990d0 190 regwr(0x0013,0x081e); //POWER CONTROL 3 (R13h)
king33jp 0:de7db46990d0 191 // X X X X VCMR X X X X X X PON VRH3 VRH2 VRH1 VRH0
king33jp 0:de7db46990d0 192 //PON=1 The operational amplifier is Start.
king33jp 0:de7db46990d0 193 //VCMR=1 VCOMH voltage=Internal electronic volume
king33jp 0:de7db46990d0 194 //VRH[5:0]=1e=011110 VCIR_EXIN X 2.250 = 4.50V
king33jp 0:de7db46990d0 195 wait_ms(20);
king33jp 0:de7db46990d0 196
king33jp 0:de7db46990d0 197 regwr(0x0001,0x0014); //DRIVER OUTPUT CONTROL (R01h)
king33jp 0:de7db46990d0 198 // X X X DPL EPL SM GS SS X X X NL4 NL3 NL2 NL1 NL0
king33jp 1:a3651128e297 199 // demo code was 0x0114,SS bit=1 is reverse horizontal.
king33jp 0:de7db46990d0 200 //DPL=0,EPL=0
king33jp 0:de7db46990d0 201 //SM=0 even/odd division is selected
king33jp 0:de7db46990d0 202 //GS=0 G1 is output first and G160 is finally output.
king33jp 0:de7db46990d0 203 //SS=1 Select the direction of the source driver channel in pixel unit.
king33jp 0:de7db46990d0 204 //NL[4:0]=10100 Drive Duty=384 X 160 dots 160 G1 to G160
king33jp 0:de7db46990d0 205
king33jp 0:de7db46990d0 206 regwr(0x0002,0x0100); //LCD INVERSION CONTROL (R02h)
king33jp 0:de7db46990d0 207 // X X X X X X FL1 FL0 X X X FLD X X X X
king33jp 0:de7db46990d0 208 //FL[1:0]=01 FLD=0 Line Inversion-1 field interlace
king33jp 0:de7db46990d0 209
king33jp 0:de7db46990d0 210 regwr(0x0003,0x0030); //ENTRY MODE (R03h)
king33jp 0:de7db46990d0 211 // X X X BGR X X MDT1 MDT0 X X ID1 ID0 AM X X X
king33jp 0:de7db46990d0 212 //BGR=0 assigned to {R, G, B}.When 18-bit data is written to GRAM through DB bus
king33jp 0:de7db46990d0 213 //MDT[1:0]=00 260k color data is transferred by 3or2-times(setting for IM) Data Transfer.
king33jp 0:de7db46990d0 214 // When user wants to transfer 260k color data on 8/16-bit parallel bus
king33jp 0:de7db46990d0 215 //ID[1:0]=11 When ID[1], ID[0] = 1, the address counter (AC) is automatically increased by 1 after the data is written to the GRAM
king33jp 0:de7db46990d0 216 //AM=0 the data is continuously written in horizontally.
king33jp 0:de7db46990d0 217
king33jp 0:de7db46990d0 218 regwr(0x0008,0x0202); //BLANK PERIOD CONTROL 1 (R08h)
king33jp 0:de7db46990d0 219 // X X X X FP3 FP2 FP1 FP0 X X X X BP3 BP2 BP1 BP0
king33jp 0:de7db46990d0 220 //FP[3:0]=0010
king33jp 0:de7db46990d0 221 //BP[3:0]=0010
king33jp 0:de7db46990d0 222 //Number of Raster Periods In Front (Back) Porch Default=2;
king33jp 0:de7db46990d0 223
king33jp 0:de7db46990d0 224 regwr(0x000b,0x0000); //FRAME CYCLE CONTROL (R0Bh)
king33jp 0:de7db46990d0 225 // X X X X X X DIV1 DIV0 X X X X RTN3 RTN2 RTN1 RTN0
king33jp 0:de7db46990d0 226 //DIV[1:0]=00 Division Ratio=1 Internal operation clock frequency=fosc/1
king33jp 0:de7db46990d0 227 //RTN[3:0]=Clock Cycles per horizontal Line= 16 (INCLKs)
king33jp 0:de7db46990d0 228
king33jp 0:de7db46990d0 229 regwr(0x000c,0x0000); //EXTERNAL DISPLAY INTERFACE CONTROL (R0Ch)
king33jp 0:de7db46990d0 230 // X X X X X X X RM X X DM1 DM0 X X RIM1 RIM0
king33jp 0:de7db46990d0 231 //RM=0 GRAM Access Interface=System interface
king33jp 0:de7db46990d0 232 //DM[1:0]=00 Display operation mode = Internal clock operation
king33jp 0:de7db46990d0 233
king33jp 0:de7db46990d0 234 regwr(0x0061,0x0018); //OSCILLATOR CONTROL (R61h)
king33jp 0:de7db46990d0 235 // X X X X X X X X X X X RADJ4 RADJ3 RADJ2 RADJ1 RADJ0
king33jp 0:de7db46990d0 236 //RADJ[4:0]=11000 Oscillation Speed=x 1.000 Default
king33jp 0:de7db46990d0 237
king33jp 0:de7db46990d0 238 regwr(0x0069,0x0000); //DC/DC CONVERT LOW POWER MODE SETTING (R69h)
king33jp 0:de7db46990d0 239 // 0 0 0 0 0 0 0 0 0 0 0 NLDC3 NLDC2 NLDC1 NLDC0 NLPM
king33jp 0:de7db46990d0 240 //NLPM=0 Normal operation mode
king33jp 0:de7db46990d0 241 //NLDC[1:0]=00 DCCLK/1
king33jp 0:de7db46990d0 242 //NLDC[3:2]=00 DCCLK/2
king33jp 0:de7db46990d0 243
king33jp 0:de7db46990d0 244 regwr(0x0070,0x0000); //SOURCE DRIVER PRE-DRIVING PERIOD SETTING (R70h)
king33jp 0:de7db46990d0 245 // X X X X X X X X SDT1 SDT0 X X X X EQ1 EQ0
king33jp 0:de7db46990d0 246 //STD[1:0]=00 Source Output Delay Control=1 DISP_CK
king33jp 0:de7db46990d0 247 //EQ=00 No Equalization Control
king33jp 0:de7db46990d0 248 regwr(0x0071,0x0000); //GATE OUTPUT PERIOD CONTROL (R71h)
king33jp 0:de7db46990d0 249 // X X X X GNO1 GNO0 X X X X X X X X X X
king33jp 0:de7db46990d0 250 //GN)=00 Non-Overlap Period Control =2 DISP_CKs
king33jp 0:de7db46990d0 251
king33jp 0:de7db46990d0 252 regwr(0x0011,0x0000); //GAMMA CONTROL 1 (R11h)
king33jp 0:de7db46990d0 253 // VR1C X X VRN14 VRN13 VRN12 VRN11 VRN10 X X X VRP14 VRP13 VRP12 VRP11 VRP10
king33jp 0:de7db46990d0 254 //VR1C=0 Control step of amplitude positive and negative of 64-grayscale.
king33jp 0:de7db46990d0 255 //VRP1[4:0]=00000 Control amplitude positive polarity of 64-grayscale.
king33jp 0:de7db46990d0 256 //VRN1[4:0]=00000 Control amplitude negative polarity of 64-grayscale.
king33jp 0:de7db46990d0 257
king33jp 0:de7db46990d0 258 /* Gamma settings -----------------------------------------------------------*/
king33jp 0:de7db46990d0 259 ///////r CONTROL
king33jp 0:de7db46990d0 260 regwr(0x0030,0x0303); //GAMMA CONTROL 2 (R30h to R37h)
king33jp 0:de7db46990d0 261 regwr(0x0031,0x0303); //GAMMA CONTROL 2 (R30h to R37h)
king33jp 0:de7db46990d0 262 regwr(0x0032,0x0303); //GAMMA CONTROL 2 (R30h to R37h)
king33jp 0:de7db46990d0 263 regwr(0x0033,0x0000); //GAMMA CONTROL 2 (R30h to R37h)
king33jp 0:de7db46990d0 264 regwr(0x0034,0x0404); //GAMMA CONTROL 2 (R30h to R37h)
king33jp 0:de7db46990d0 265 regwr(0x0035,0x0404); //GAMMA CONTROL 2 (R30h to R37h)
king33jp 0:de7db46990d0 266 regwr(0x0036,0x0404); //GAMMA CONTROL 2 (R30h to R37h)
king33jp 0:de7db46990d0 267 regwr(0x0037,0x0000); //GAMMA CONTROL 2 (R30h to R37h)
king33jp 0:de7db46990d0 268 regwr(0x0038,0x0707); //GAMMA CONTROL 2 (R38h)
king33jp 0:de7db46990d0 269 ///////Coordinatioontrol setting
king33jp 0:de7db46990d0 270 regwr(0x0040,0x0000); // GATE SCAN POSITION (R40h)
king33jp 0:de7db46990d0 271 // 1 X X X X X X X X X X X SCN4 SCN3 SCN2 SCN1 SCN0
king33jp 0:de7db46990d0 272 //Set the scanning starting position of the gate driver.
king33jp 0:de7db46990d0 273
king33jp 0:de7db46990d0 274 regwr(0x0042,0x9f00); //1st SCREEN DRIVING POSITION (R42h)
king33jp 0:de7db46990d0 275 // SE17 SE16 SE15 SE14 SE13 SE12 SE11 SE10 SS17 SS16 SS15 SS14 SS13 SS12 SS11 SS10
king33jp 0:de7db46990d0 276
king33jp 0:de7db46990d0 277 regwr(0x0043,0x0000); //2nd SCREEN DRIVING POSITION (R43h)
king33jp 0:de7db46990d0 278 // SE27 SE26 SE25 SE24 SE23 SE22 SE21 SE20 SS27 SS26 SS25 SS24 SS23 SS22 SS21 SS20
king33jp 0:de7db46990d0 279 regwr(0x0044,0x7f00); //HORIZONTAL RAM ADDRESS POSITION (R44h)
king33jp 0:de7db46990d0 280
king33jp 0:de7db46990d0 281 regwr(0x0045,0x9f00); //VERTICAL RAM ADDRESS POSITION (R45h)
king33jp 0:de7db46990d0 282
king33jp 0:de7db46990d0 283 regwr(0x0069,0x0000); //DC/DC CONVERT LOW POWER MODE SETTING (R69h)
king33jp 0:de7db46990d0 284 // 0 0 0 0 0 0 0 0 0 0 0 NLDC3 NLDC2 NLDC1 NLDC0 NLPM
king33jp 0:de7db46990d0 285 //NLPM=0 Normal operation mode
king33jp 0:de7db46990d0 286 //NLDC[1:0]=00 DCCLK/1
king33jp 0:de7db46990d0 287 //NLDC[3:2]=00 DCCLK/2
king33jp 0:de7db46990d0 288
king33jp 0:de7db46990d0 289 regwr(0x0070,0x0000); //SOURCE DRIVER PRE-DRIVING PERIOD SETTING (R70h)
king33jp 0:de7db46990d0 290 // X X X X X X X X SDT1 SDT0 X X X X EQ1 EQ0
king33jp 0:de7db46990d0 291 //STD[1:0]=00 Source Output Delay Control=1 DISP_CK
king33jp 0:de7db46990d0 292 //EQ=00 No Equalization Control
king33jp 0:de7db46990d0 293
king33jp 0:de7db46990d0 294 regwr(0x0071,0x0000); //GATE OUTPUT PERIOD CONTROL (R71h)
king33jp 0:de7db46990d0 295 // X X X X GNO1 GNO0 X X X X X X X X X X
king33jp 0:de7db46990d0 296 //GNO=00 Non-Overlap Period Control =2 DISP_CKs
king33jp 0:de7db46990d0 297
king33jp 0:de7db46990d0 298 regwr(0x0073,0x0000); //TEST_KEY (R73h)
king33jp 0:de7db46990d0 299 // X X X X X X X X TEST_KEY[7:0]
king33jp 0:de7db46990d0 300 //When you want to update MTP data, “A5” should be written to this register.
king33jp 0:de7db46990d0 301
king33jp 0:de7db46990d0 302 regwr(0x00B3,0x0000); //PUMPING CLOCK SOURCE SELECTION (RB3h)
king33jp 0:de7db46990d0 303 // X 0 0 0 X 0 1 0 X X X DCR_EX X X X 1
king33jp 0:de7db46990d0 304 //Select the source of pumping clock.
king33jp 0:de7db46990d0 305 //In RGB mode, DCR_EX should be set before power setting.
king33jp 0:de7db46990d0 306
king33jp 0:de7db46990d0 307 regwr(0x00BD,0x0000); //MTP DATA READ (RBDh)
king33jp 0:de7db46990d0 308 // X X X X X X X DISEN X MTP_DOUT[6:0]
king33jp 0:de7db46990d0 309 //DISEN=0 Standby mode discharge circuit operation stop.
king33jp 0:de7db46990d0 310 //MTP_DOUT MTP data read using MTP_READ register.
king33jp 0:de7db46990d0 311
king33jp 0:de7db46990d0 312 regwr(0x00BE,0x0000); //INTERFACE MODE SELECTION (RBEh)
king33jp 0:de7db46990d0 313 // X X X X X X X X X X X IM_SEL IM_3 X X FLM_MSK
king33jp 0:de7db46990d0 314 //IM_SEL register selects interface mode.
king33jp 0:de7db46990d0 315 //IM_SEL=0 is IM[3:0] setting
king33jp 0:de7db46990d0 316
king33jp 0:de7db46990d0 317 regwr(0x0021,0x0000); //GRAM ADDRESS SET (R21h)
king33jp 0:de7db46990d0 318 // AD15 AD14 AD13 AD12 AD11 AD10 AD9 AD8 AD7 AD6 AD5 AD4 AD3 AD2 AD1 AD0
king33jp 0:de7db46990d0 319 // You can write initial GRAM address into internal Address Counter (AC).
king33jp 0:de7db46990d0 320
king33jp 0:de7db46990d0 321 reg0(0x0022); //WRITE DATA TO GRAM (R22h)
king33jp 0:de7db46990d0 322 // RAM write data (WD17 ~ WB0). Interface mode controls the width of WD
king33jp 0:de7db46990d0 323 // Data on DB bus is expanded to 18-bits before being written to GRAM and the data determines grayscale level of S6D0151’s source output.
king33jp 0:de7db46990d0 324 wait_ms(20);
king33jp 0:de7db46990d0 325
king33jp 0:de7db46990d0 326 regwr(0x0007,0x0020); //DISPLAY CONTROL (R07h)
king33jp 0:de7db46990d0 327 // X X X PT1 PT0 X X SPT X X GON DTE CL REV D1 D0
king33jp 0:de7db46990d0 328 //PT[1:0]=00 V63/V0 Normal Drive
king33jp 0:de7db46990d0 329 //SPT=0 Split Screen Driving Function is Not performed
king33jp 0:de7db46990d0 330 //GON=1,DTE=0 Normal operation
king33jp 0:de7db46990d0 331 //CL=0 262,144 colors / 65,536 colors
king33jp 0:de7db46990d0 332 //REV=0 Displays all character and graphics display sections with Normal
king33jp 0:de7db46990d0 333 //D[1:0]=00 the internal display operation halts and the display is off.
king33jp 0:de7db46990d0 334 wait_ms(5);
king33jp 0:de7db46990d0 335
king33jp 0:de7db46990d0 336 regwr(0x0007,0x0021); //DISPLAY CONTROL (R07h)
king33jp 0:de7db46990d0 337 // X X X PT1 PT0 X X SPT X X GON DTE CL REV D1 D0
king33jp 0:de7db46990d0 338 //D[1:0]=01 the internal display operation halts and the display is off.
king33jp 0:de7db46990d0 339
king33jp 0:de7db46990d0 340 regwr(0x0007,0x0027); //DISPLAY CONTROL (R07h)
king33jp 0:de7db46990d0 341 // X X X PT1 PT0 X X SPT X X GON DTE CL REV D1 D0
king33jp 0:de7db46990d0 342 //REV=1 Displays all character and graphics display sections with Reverse
king33jp 0:de7db46990d0 343 //D[1:0]=11 the internal display operation halts and the display is off.
king33jp 0:de7db46990d0 344
king33jp 0:de7db46990d0 345 wait_ms(50);
king33jp 0:de7db46990d0 346 regwr(0x0007,0x0037); //DISPLAY CONTROL (R07h)
king33jp 0:de7db46990d0 347 // X X X PT1 PT0 X X SPT X X GON DTE CL REV D1 D0
king33jp 0:de7db46990d0 348 //GON=1,DTE=1 VGH/VGL Normal operation
king33jp 1:a3651128e297 349 //Rev bit mean Color reverse.
king33jp 0:de7db46990d0 350 //REV=1 Displays all character and graphics display sections with Reverse
king33jp 0:de7db46990d0 351 //D[1:0]=11 Display is RAM data
king33jp 0:de7db46990d0 352
king33jp 1:a3651128e297 353 /*　Up to here, demo code reference partsas ------------------------------*/
king33jp 1:a3651128e297 354
king33jp 0:de7db46990d0 355 WindowMax ();
king33jp 0:de7db46990d0 356 }
king33jp 0:de7db46990d0 357
king33jp 0:de7db46990d0 358
king33jp 0:de7db46990d0 359 void S6D0151_TFT::pixel(int x, int y, int color) {
king33jp 0:de7db46990d0 360 if ((x >= width()) || (y >= height())) return;
king33jp 0:de7db46990d0 361
king33jp 0:de7db46990d0 362 window(x,y,1,1);
king33jp 0:de7db46990d0 363
king33jp 0:de7db46990d0 364 wr_dat_start();
king33jp 0:de7db46990d0 365 _spi.write(color >> 8);
king33jp 0:de7db46990d0 366 _spi.write(color & 0xFF);
king33jp 0:de7db46990d0 367 wr_dat_stop();
king33jp 0:de7db46990d0 368
king33jp 0:de7db46990d0 369 }
king33jp 0:de7db46990d0 370
king33jp 0:de7db46990d0 371 void S6D0151_TFT::window (unsigned int x, unsigned int y, unsigned int w, unsigned int h) {
king33jp 0:de7db46990d0 372 unsigned int hea,hsa,vea,vsa,dd;
king33jp 0:de7db46990d0 373 hea=x+w-1;
king33jp 0:de7db46990d0 374 hsa=x;
king33jp 0:de7db46990d0 375 vea=y+h-1;
king33jp 0:de7db46990d0 376 vsa=y;
king33jp 0:de7db46990d0 377
king33jp 0:de7db46990d0 378 dd=((hea&0xff)<<8)|(hsa&0xff);
king33jp 0:de7db46990d0 379 regwr(0x0044, dd ); //HORIZONTAL RAM ADDRESS POSITION (R44h)
king33jp 0:de7db46990d0 380 dd=((vea&0xff)<<8)|(vsa&0xff);
king33jp 0:de7db46990d0 381 regwr(0x0045, dd ); //VERTICAL RAM ADDRESS POSITION (R45h)
king33jp 0:de7db46990d0 382
king33jp 1:a3651128e297 383 // set_start_address(hea,vea);
king33jp 1:a3651128e297 384 set_start_address(hsa,vsa);
king33jp 0:de7db46990d0 385 reg0(0x0022); //Write data to GRAM
king33jp 0:de7db46990d0 386 }
king33jp 0:de7db46990d0 387
king33jp 0:de7db46990d0 388
king33jp 0:de7db46990d0 389 void S6D0151_TFT::WindowMax (void) {
king33jp 0:de7db46990d0 390 window (0, 0, width(), height());
king33jp 0:de7db46990d0 391 }
king33jp 0:de7db46990d0 392
king33jp 0:de7db46990d0 393
king33jp 0:de7db46990d0 394 void S6D0151_TFT::cls (void) {
king33jp 0:de7db46990d0 395 unsigned int i;
king33jp 0:de7db46990d0 396 WindowMax();
king33jp 0:de7db46990d0 397
king33jp 0:de7db46990d0 398 wr_dat_start();
king33jp 0:de7db46990d0 399 for (i = 0; i < ( (width()+1) * (height()+3)); i++) {
king33jp 0:de7db46990d0 400 _spi.write(_background >> 8);
king33jp 0:de7db46990d0 401 _spi.write(_background & 0xFF);
king33jp 0:de7db46990d0 402 }
king33jp 0:de7db46990d0 403 wr_dat_stop();
king33jp 0:de7db46990d0 404 }
king33jp 0:de7db46990d0 405
king33jp 0:de7db46990d0 406
king33jp 0:de7db46990d0 407 void S6D0151_TFT::circle(int x0, int y0, int r, int color) {
king33jp 0:de7db46990d0 408
king33jp 0:de7db46990d0 409 int draw_x0, draw_y0;
king33jp 0:de7db46990d0 410 int draw_x1, draw_y1;
king33jp 0:de7db46990d0 411 int draw_x2, draw_y2;
king33jp 0:de7db46990d0 412 int draw_x3, draw_y3;
king33jp 0:de7db46990d0 413 int draw_x4, draw_y4;
king33jp 0:de7db46990d0 414 int draw_x5, draw_y5;
king33jp 0:de7db46990d0 415 int draw_x6, draw_y6;
king33jp 0:de7db46990d0 416 int draw_x7, draw_y7;
king33jp 0:de7db46990d0 417 int xx, yy;
king33jp 0:de7db46990d0 418 int di;
king33jp 0:de7db46990d0 419 WindowMax();
king33jp 0:de7db46990d0 420 if (r == 0) { /* no radius */
king33jp 0:de7db46990d0 421 return;
king33jp 0:de7db46990d0 422 }
king33jp 0:de7db46990d0 423
king33jp 0:de7db46990d0 424 draw_x0 = draw_x1 = x0;
king33jp 0:de7db46990d0 425 draw_y0 = draw_y1 = y0 + r;
king33jp 0:de7db46990d0 426 if (draw_y0 < height()) {
king33jp 0:de7db46990d0 427 pixel(draw_x0, draw_y0, color); /* 90 degree */
king33jp 0:de7db46990d0 428 }
king33jp 0:de7db46990d0 429
king33jp 0:de7db46990d0 430 draw_x2 = draw_x3 = x0;
king33jp 0:de7db46990d0 431 draw_y2 = draw_y3 = y0 - r;
king33jp 0:de7db46990d0 432 if (draw_y2 >= 0) {
king33jp 0:de7db46990d0 433 pixel(draw_x2, draw_y2, color); /* 270 degree */
king33jp 0:de7db46990d0 434 }
king33jp 0:de7db46990d0 435
king33jp 0:de7db46990d0 436 draw_x4 = draw_x6 = x0 + r;
king33jp 0:de7db46990d0 437 draw_y4 = draw_y6 = y0;
king33jp 0:de7db46990d0 438 if (draw_x4 < width()) {
king33jp 0:de7db46990d0 439 pixel(draw_x4, draw_y4, color); /* 0 degree */
king33jp 0:de7db46990d0 440 }
king33jp 0:de7db46990d0 441
king33jp 0:de7db46990d0 442 draw_x5 = draw_x7 = x0 - r;
king33jp 0:de7db46990d0 443 draw_y5 = draw_y7 = y0;
king33jp 0:de7db46990d0 444 if (draw_x5>=0) {
king33jp 0:de7db46990d0 445 pixel(draw_x5, draw_y5, color); /* 180 degree */
king33jp 0:de7db46990d0 446 }
king33jp 0:de7db46990d0 447
king33jp 0:de7db46990d0 448 if (r == 1) {
king33jp 0:de7db46990d0 449 return;
king33jp 0:de7db46990d0 450 }
king33jp 0:de7db46990d0 451
king33jp 0:de7db46990d0 452 di = 3 - 2*r;
king33jp 0:de7db46990d0 453 xx = 0;
king33jp 0:de7db46990d0 454 yy = r;
king33jp 0:de7db46990d0 455 while (xx < yy) {
king33jp 0:de7db46990d0 456
king33jp 0:de7db46990d0 457 if (di < 0) {
king33jp 0:de7db46990d0 458 di += 4*xx + 6;
king33jp 0:de7db46990d0 459 } else {
king33jp 0:de7db46990d0 460 di += 4*(xx - yy) + 10;
king33jp 0:de7db46990d0 461 yy--;
king33jp 0:de7db46990d0 462 draw_y0--;
king33jp 0:de7db46990d0 463 draw_y1--;
king33jp 0:de7db46990d0 464 draw_y2++;
king33jp 0:de7db46990d0 465 draw_y3++;
king33jp 0:de7db46990d0 466 draw_x4--;
king33jp 0:de7db46990d0 467 draw_x5++;
king33jp 0:de7db46990d0 468 draw_x6--;
king33jp 0:de7db46990d0 469 draw_x7++;
king33jp 0:de7db46990d0 470 }
king33jp 0:de7db46990d0 471 xx++;
king33jp 0:de7db46990d0 472 draw_x0++;
king33jp 0:de7db46990d0 473 draw_x1--;
king33jp 0:de7db46990d0 474 draw_x2++;
king33jp 0:de7db46990d0 475 draw_x3--;
king33jp 0:de7db46990d0 476 draw_y4++;
king33jp 0:de7db46990d0 477 draw_y5++;
king33jp 0:de7db46990d0 478 draw_y6--;
king33jp 0:de7db46990d0 479 draw_y7--;
king33jp 0:de7db46990d0 480
king33jp 0:de7db46990d0 481 if ( (draw_x0 <= width()) && (draw_y0>=0) ) {
king33jp 0:de7db46990d0 482 pixel(draw_x0, draw_y0, color);
king33jp 0:de7db46990d0 483 }
king33jp 0:de7db46990d0 484
king33jp 0:de7db46990d0 485 if ( (draw_x1 >= 0) && (draw_y1 >= 0) ) {
king33jp 0:de7db46990d0 486 pixel(draw_x1, draw_y1, color);
king33jp 0:de7db46990d0 487 }
king33jp 0:de7db46990d0 488
king33jp 0:de7db46990d0 489 if ( (draw_x2 <= width()) && (draw_y2 <= height()) ) {
king33jp 0:de7db46990d0 490 pixel(draw_x2, draw_y2, color);
king33jp 0:de7db46990d0 491 }
king33jp 0:de7db46990d0 492
king33jp 0:de7db46990d0 493 if ( (draw_x3 >=0 ) && (draw_y3 <= height()) ) {
king33jp 0:de7db46990d0 494 pixel(draw_x3, draw_y3, color);
king33jp 0:de7db46990d0 495 }
king33jp 0:de7db46990d0 496
king33jp 0:de7db46990d0 497 if ( (draw_x4 <= width()) && (draw_y4 >= 0) ) {
king33jp 0:de7db46990d0 498 pixel(draw_x4, draw_y4, color);
king33jp 0:de7db46990d0 499 }
king33jp 0:de7db46990d0 500
king33jp 0:de7db46990d0 501 if ( (draw_x5 >= 0) && (draw_y5 >= 0) ) {
king33jp 0:de7db46990d0 502 pixel(draw_x5, draw_y5, color);
king33jp 0:de7db46990d0 503 }
king33jp 0:de7db46990d0 504 if ( (draw_x6 <=width()) && (draw_y6 <= height()) ) {
king33jp 0:de7db46990d0 505 pixel(draw_x6, draw_y6, color);
king33jp 0:de7db46990d0 506 }
king33jp 0:de7db46990d0 507 if ( (draw_x7 >= 0) && (draw_y7 <= height()) ) {
king33jp 0:de7db46990d0 508 pixel(draw_x7, draw_y7, color);
king33jp 0:de7db46990d0 509 }
king33jp 0:de7db46990d0 510 }
king33jp 0:de7db46990d0 511 return;
king33jp 0:de7db46990d0 512 }
king33jp 0:de7db46990d0 513
king33jp 0:de7db46990d0 514 void S6D0151_TFT::fillcircle(int x, int y, int r, int color) {
king33jp 0:de7db46990d0 515 int i;
king33jp 0:de7db46990d0 516 for (i = 0; i <= r; i++)
king33jp 0:de7db46990d0 517 circle(x,y,i,color);
king33jp 0:de7db46990d0 518 }
king33jp 0:de7db46990d0 519
king33jp 0:de7db46990d0 520 void S6D0151_TFT::fillcircle2(int x0, int y0, int r, int color){
king33jp 0:de7db46990d0 521 int x = -r, y = 0, err = 2-2*r, e2;
king33jp 0:de7db46990d0 522 do {
king33jp 0:de7db46990d0 523 vline(x0-x, y0-y, y0+y, color);
king33jp 0:de7db46990d0 524 vline(x0+x, y0-y, y0+y, color);
king33jp 0:de7db46990d0 525 e2 = err;
king33jp 0:de7db46990d0 526 if (e2 <= y) {
king33jp 0:de7db46990d0 527 err += ++y*2+1;
king33jp 0:de7db46990d0 528 if (-x == y && e2 <= x) e2 = 0;
king33jp 0:de7db46990d0 529 }
king33jp 0:de7db46990d0 530 if (e2 > x) err += ++x*2+1;
king33jp 0:de7db46990d0 531 } while (x <= 0);
king33jp 0:de7db46990d0 532 }
king33jp 0:de7db46990d0 533
king33jp 0:de7db46990d0 534 void S6D0151_TFT::hline(int x0, int x1, int y, int color) {
king33jp 0:de7db46990d0 535 int w;
king33jp 0:de7db46990d0 536 w = x1 - x0 + 1;
king33jp 0:de7db46990d0 537 window(x0,y,w,1);
king33jp 0:de7db46990d0 538 wr_dat_start();
king33jp 0:de7db46990d0 539 for (int x=0; x<w; x++) {
king33jp 0:de7db46990d0 540 _spi.write(color >> 8);
king33jp 0:de7db46990d0 541 _spi.write(color);
king33jp 0:de7db46990d0 542 }
king33jp 0:de7db46990d0 543 wr_dat_stop();
king33jp 0:de7db46990d0 544 return;
king33jp 0:de7db46990d0 545 }
king33jp 0:de7db46990d0 546
king33jp 0:de7db46990d0 547
king33jp 0:de7db46990d0 548
king33jp 0:de7db46990d0 549 void S6D0151_TFT::vline(int x, int y0, int y1, int color) {
king33jp 0:de7db46990d0 550 int h;
king33jp 0:de7db46990d0 551 h = y1 - y0 + 1;
king33jp 0:de7db46990d0 552 window(x,y0,1,h);
king33jp 0:de7db46990d0 553 wr_dat_start();
king33jp 0:de7db46990d0 554 for (int y=0; y<h; y++) {
king33jp 0:de7db46990d0 555 _spi.write(color >> 8);
king33jp 0:de7db46990d0 556 _spi.write(color);
king33jp 0:de7db46990d0 557 }
king33jp 0:de7db46990d0 558 wr_dat_stop();
king33jp 0:de7db46990d0 559 return;
king33jp 0:de7db46990d0 560 }
king33jp 0:de7db46990d0 561
king33jp 0:de7db46990d0 562
king33jp 0:de7db46990d0 563
king33jp 0:de7db46990d0 564 void S6D0151_TFT::line(int x0, int y0, int x1, int y1, int color) {
king33jp 0:de7db46990d0 565 WindowMax();
king33jp 0:de7db46990d0 566 int dx = 0, dy = 0;
king33jp 0:de7db46990d0 567 int dx_sym = 0, dy_sym = 0;
king33jp 0:de7db46990d0 568 int dx_x2 = 0, dy_x2 = 0;
king33jp 0:de7db46990d0 569 int di = 0;
king33jp 0:de7db46990d0 570
king33jp 0:de7db46990d0 571 dx = x1-x0;
king33jp 0:de7db46990d0 572 dy = y1-y0;
king33jp 0:de7db46990d0 573
king33jp 0:de7db46990d0 574 if (dx == 0) { /* vertical line */
king33jp 0:de7db46990d0 575 if (y1 > y0) vline(x0,y0,y1,color);
king33jp 0:de7db46990d0 576 else vline(x0,y1,y0,color);
king33jp 0:de7db46990d0 577 return;
king33jp 0:de7db46990d0 578 }
king33jp 0:de7db46990d0 579
king33jp 0:de7db46990d0 580 if (dx > 0) {
king33jp 0:de7db46990d0 581 dx_sym = 1;
king33jp 0:de7db46990d0 582 } else {
king33jp 0:de7db46990d0 583 dx_sym = -1;
king33jp 0:de7db46990d0 584 }
king33jp 0:de7db46990d0 585 if (dy == 0) { /* horizontal line */
king33jp 0:de7db46990d0 586 if (x1 > x0) hline(x0,x1,y0,color);
king33jp 0:de7db46990d0 587 else hline(x1,x0,y0,color);
king33jp 0:de7db46990d0 588 return;
king33jp 0:de7db46990d0 589 }
king33jp 0:de7db46990d0 590
king33jp 0:de7db46990d0 591 if (dy > 0) {
king33jp 0:de7db46990d0 592 dy_sym = 1;
king33jp 0:de7db46990d0 593 } else {
king33jp 0:de7db46990d0 594 dy_sym = -1;
king33jp 0:de7db46990d0 595 }
king33jp 0:de7db46990d0 596
king33jp 0:de7db46990d0 597 dx = dx_sym*dx;
king33jp 0:de7db46990d0 598 dy = dy_sym*dy;
king33jp 0:de7db46990d0 599
king33jp 0:de7db46990d0 600 dx_x2 = dx*2;
king33jp 0:de7db46990d0 601 dy_x2 = dy*2;
king33jp 0:de7db46990d0 602
king33jp 0:de7db46990d0 603 if (dx >= dy) {
king33jp 0:de7db46990d0 604 di = dy_x2 - dx;
king33jp 0:de7db46990d0 605 while (x0 != x1) {
king33jp 0:de7db46990d0 606
king33jp 0:de7db46990d0 607 pixel(x0, y0, color);
king33jp 0:de7db46990d0 608 x0 += dx_sym;
king33jp 0:de7db46990d0 609 if (di<0) {
king33jp 0:de7db46990d0 610 di += dy_x2;
king33jp 0:de7db46990d0 611 } else {
king33jp 0:de7db46990d0 612 di += dy_x2 - dx_x2;
king33jp 0:de7db46990d0 613 y0 += dy_sym;
king33jp 0:de7db46990d0 614 }
king33jp 0:de7db46990d0 615 }
king33jp 0:de7db46990d0 616 pixel(x0, y0, color);
king33jp 0:de7db46990d0 617 } else {
king33jp 0:de7db46990d0 618 di = dx_x2 - dy;
king33jp 0:de7db46990d0 619 while (y0 != y1) {
king33jp 0:de7db46990d0 620 pixel(x0, y0, color);
king33jp 0:de7db46990d0 621 y0 += dy_sym;
king33jp 0:de7db46990d0 622 if (di < 0) {
king33jp 0:de7db46990d0 623 di += dx_x2;
king33jp 0:de7db46990d0 624 } else {
king33jp 0:de7db46990d0 625 di += dx_x2 - dy_x2;
king33jp 0:de7db46990d0 626 x0 += dx_sym;
king33jp 0:de7db46990d0 627 }
king33jp 0:de7db46990d0 628 }
king33jp 0:de7db46990d0 629 pixel(x0, y0, color);
king33jp 0:de7db46990d0 630 }
king33jp 0:de7db46990d0 631 return;
king33jp 0:de7db46990d0 632 }
king33jp 0:de7db46990d0 633
king33jp 0:de7db46990d0 634
king33jp 0:de7db46990d0 635
king33jp 0:de7db46990d0 636
king33jp 0:de7db46990d0 637 void S6D0151_TFT::rect(int x0, int y0, int x1, int y1, int color) {
king33jp 0:de7db46990d0 638
king33jp 0:de7db46990d0 639 if (x1 > x0) hline(x0,x1,y0,color);
king33jp 0:de7db46990d0 640 else hline(x1,x0,y0,color);
king33jp 0:de7db46990d0 641
king33jp 0:de7db46990d0 642 if (y1 > y0) vline(x0,y0,y1,color);
king33jp 0:de7db46990d0 643 else vline(x0,y1,y0,color);
king33jp 0:de7db46990d0 644
king33jp 0:de7db46990d0 645 if (x1 > x0) hline(x0,x1,y1,color);
king33jp 0:de7db46990d0 646 else hline(x1,x0,y1,color);
king33jp 0:de7db46990d0 647
king33jp 0:de7db46990d0 648 if (y1 > y0) vline(x1,y0,y1,color);
king33jp 0:de7db46990d0 649 else vline(x1,y1,y0,color);
king33jp 0:de7db46990d0 650
king33jp 0:de7db46990d0 651 return;
king33jp 0:de7db46990d0 652 }
king33jp 0:de7db46990d0 653
king33jp 0:de7db46990d0 654
king33jp 0:de7db46990d0 655
king33jp 0:de7db46990d0 656 void S6D0151_TFT::fillrect(int x0, int y0, int x1, int y1, int color) {
king33jp 0:de7db46990d0 657
king33jp 0:de7db46990d0 658 int h = y1 - y0 + 1;
king33jp 0:de7db46990d0 659 int w = x1 - x0 + 1;
king33jp 0:de7db46990d0 660 int pixel = h * w;
king33jp 0:de7db46990d0 661 window(x0,y0,w,h);
king33jp 0:de7db46990d0 662 wr_dat_start();
king33jp 0:de7db46990d0 663 for (int p=0; p<pixel; p++) {
king33jp 0:de7db46990d0 664 _spi.write(color >> 8);
king33jp 5:18920a7a693e 665 _spi.write(color & 0xFF);
king33jp 0:de7db46990d0 666 }
king33jp 0:de7db46990d0 667 wr_dat_stop();
king33jp 0:de7db46990d0 668 return;
king33jp 0:de7db46990d0 669 }
king33jp 0:de7db46990d0 670
king33jp 0:de7db46990d0 671
king33jp 0:de7db46990d0 672
king33jp 0:de7db46990d0 673 void S6D0151_TFT::locate(int x, int y) {
king33jp 0:de7db46990d0 674 char_x = x;
king33jp 0:de7db46990d0 675 char_y = y;
king33jp 0:de7db46990d0 676 }
king33jp 0:de7db46990d0 677
king33jp 0:de7db46990d0 678
king33jp 0:de7db46990d0 679
king33jp 0:de7db46990d0 680 int S6D0151_TFT::columns() {
king33jp 0:de7db46990d0 681 return width() / font[1];
king33jp 0:de7db46990d0 682 }
king33jp 0:de7db46990d0 683
king33jp 0:de7db46990d0 684
king33jp 0:de7db46990d0 685
king33jp 0:de7db46990d0 686 int S6D0151_TFT::rows() {
king33jp 0:de7db46990d0 687 return height() / font[2];
king33jp 0:de7db46990d0 688 }
king33jp 0:de7db46990d0 689
king33jp 0:de7db46990d0 690
king33jp 0:de7db46990d0 691
king33jp 0:de7db46990d0 692 int S6D0151_TFT::_putc(int value) {
king33jp 0:de7db46990d0 693 if (value == '\n') { // new line
king33jp 0:de7db46990d0 694 char_x = 0;
king33jp 0:de7db46990d0 695 char_y = char_y + font[2];
king33jp 0:de7db46990d0 696 if (char_y >= height() - font[2]) {
king33jp 0:de7db46990d0 697 char_y = 0;
king33jp 0:de7db46990d0 698 }
king33jp 0:de7db46990d0 699 } else {
king33jp 0:de7db46990d0 700 character(char_x, char_y, value);
king33jp 0:de7db46990d0 701 }
king33jp 0:de7db46990d0 702 return value;
king33jp 0:de7db46990d0 703 }
king33jp 0:de7db46990d0 704
king33jp 0:de7db46990d0 705
king33jp 0:de7db46990d0 706
king33jp 0:de7db46990d0 707
king33jp 0:de7db46990d0 708 void S6D0151_TFT::character(int x, int y, int c) {
king33jp 0:de7db46990d0 709 unsigned int hor,vert,offset,bpl,j,i,b;
king33jp 0:de7db46990d0 710 unsigned char* zeichen;
king33jp 0:de7db46990d0 711 unsigned char z,w;
king33jp 0:de7db46990d0 712
king33jp 0:de7db46990d0 713 if ((c < 31) || (c > 156)) return; // test char range
king33jp 0:de7db46990d0 714
king33jp 0:de7db46990d0 715 // read font parameter from start of array
king33jp 0:de7db46990d0 716 offset = font[0]; // bytes / char
king33jp 0:de7db46990d0 717 hor = font[1]; // get hor size of font
king33jp 0:de7db46990d0 718 vert = font[2]; // get vert size of font
king33jp 0:de7db46990d0 719 bpl = font[3]; // bytes per line
king33jp 0:de7db46990d0 720
king33jp 0:de7db46990d0 721 if (char_x + hor > width()) {
king33jp 0:de7db46990d0 722 char_x = 0;
king33jp 0:de7db46990d0 723 char_y = char_y + vert;
king33jp 0:de7db46990d0 724 if (char_y >= height() - font[2]) {
king33jp 0:de7db46990d0 725 char_y = 0;
king33jp 0:de7db46990d0 726 }
king33jp 0:de7db46990d0 727 }
king33jp 0:de7db46990d0 728
king33jp 0:de7db46990d0 729 window(char_x, char_y,hor,vert); // char box
king33jp 0:de7db46990d0 730 wr_dat_start();
king33jp 0:de7db46990d0 731 zeichen = &font[((c -32) * offset) + 4]; // start of char bitmap
king33jp 0:de7db46990d0 732 w = zeichen[0]; // width of actual char
king33jp 0:de7db46990d0 733
king33jp 0:de7db46990d0 734 for (j=0; j<vert; j++) { // vert line
king33jp 0:de7db46990d0 735 for (i=0; i<hor; i++) { // horz line
king33jp 0:de7db46990d0 736 z = zeichen[bpl * i + ((j & 0xF8) >> 3)+1];
king33jp 0:de7db46990d0 737 b = 1 << (j & 0x07);
king33jp 0:de7db46990d0 738 if (( z & b ) == 0x00) {
king33jp 0:de7db46990d0 739 _spi.write(_background >> 8);
king33jp 0:de7db46990d0 740 _spi.write(_background & 0xff);
king33jp 0:de7db46990d0 741 } else {
king33jp 0:de7db46990d0 742 _spi.write(_foreground >> 8);
king33jp 0:de7db46990d0 743 _spi.write(_foreground & 0xff);
king33jp 0:de7db46990d0 744 }
king33jp 0:de7db46990d0 745 }
king33jp 0:de7db46990d0 746 }
king33jp 0:de7db46990d0 747 wr_dat_stop();
king33jp 0:de7db46990d0 748 if ((w + 2) < hor) { // x offset to next char
king33jp 0:de7db46990d0 749 char_x += w + 2;
king33jp 0:de7db46990d0 750 } else char_x += hor;
king33jp 0:de7db46990d0 751 }
king33jp 0:de7db46990d0 752
king33jp 0:de7db46990d0 753 void S6D0151_TFT::set_font(unsigned char* f) {
king33jp 0:de7db46990d0 754 font = f;
king33jp 0:de7db46990d0 755 }
king33jp 0:de7db46990d0 756
king33jp 0:de7db46990d0 757
king33jp 0:de7db46990d0 758
king33jp 0:de7db46990d0 759 void S6D0151_TFT::Bitmap(unsigned int x, unsigned int y, unsigned int w, unsigned int h,unsigned char *bitmap) {
king33jp 0:de7db46990d0 760 unsigned int i,j;
king33jp 0:de7db46990d0 761 unsigned short *bitmap_ptr = (unsigned short *)bitmap;
king33jp 0:de7db46990d0 762 window(x, y, w, h);
king33jp 0:de7db46990d0 763 wr_dat_start();
king33jp 0:de7db46990d0 764 for (j = 0; j < h; j++) { //Lines
king33jp 0:de7db46990d0 765 for (i = 0; i < w; i++) { // copy pixel data to TFT
king33jp 0:de7db46990d0 766
king33jp 0:de7db46990d0 767 _spi.write(*bitmap_ptr >> 8);
king33jp 0:de7db46990d0 768 _spi.write(*bitmap_ptr); // one line
king33jp 0:de7db46990d0 769
king33jp 0:de7db46990d0 770 bitmap_ptr++;
king33jp 0:de7db46990d0 771 }
king33jp 0:de7db46990d0 772 }
king33jp 0:de7db46990d0 773 wr_dat_stop();
king33jp 0:de7db46990d0 774 }
king33jp 0:de7db46990d0 775
king33jp 0:de7db46990d0 776