Yasushi Maruishi / Mbed 2 deprecated Interface_FRDMK64F_HMD_Sample_full

Stand-alone HMD demo system built on mbed FRDM-K64F.

Dependencies:   SDFileSystem mbed FATFileSystem

main.cpp@0:9bbe50de69d8, 2014-07-29 (annotated)

Committer:
maruishi
Date:
Tue Jul 29 11:41:59 2014 +0000
Revision:
0:9bbe50de69d8
FRDM-K64F based 3D Head-mount-display for Interface(CQ Pub)

Who changed what in which revision?

UserRevisionLine numberNew contents of line
maruishi 0:9bbe50de69d8 1 #include "mbed.h"
maruishi 0:9bbe50de69d8 2 #include "SDFileSystem.h"
maruishi 0:9bbe50de69d8 3
maruishi 0:9bbe50de69d8 4 DigitalOut myled(LED_GREEN);
maruishi 0:9bbe50de69d8 5 Serial pc(PTC17, PTC16);
maruishi 0:9bbe50de69d8 6 DigitalOut lcd_rs1(PTB19);
maruishi 0:9bbe50de69d8 7 DigitalOut lcd_cs1(PTB18);
maruishi 0:9bbe50de69d8 8 DigitalOut lcd_cs2(PTC1);
maruishi 0:9bbe50de69d8 9 DigitalOut lcd_rst(PTC8);
maruishi 0:9bbe50de69d8 10
maruishi 0:9bbe50de69d8 11 DigitalIn push_sw(SW2);
maruishi 0:9bbe50de69d8 12
maruishi 0:9bbe50de69d8 13 SPI spi(PTD2,PTD3,PTD1);
maruishi 0:9bbe50de69d8 14 SDFileSystem sd(PTE3, PTE1, PTE2, PTE4, "sd");
maruishi 0:9bbe50de69d8 15
maruishi 0:9bbe50de69d8 16 /*
maruishi 0:9bbe50de69d8 17 LCDモジュールへのコマンドの送信(1バイト)
maruishi 0:9bbe50de69d8 18 */
maruishi 0:9bbe50de69d8 19 void lcd_command_write(unsigned char c)
maruishi 0:9bbe50de69d8 20 {
maruishi 0:9bbe50de69d8 21 lcd_rs1 = 0;
maruishi 0:9bbe50de69d8 22 spi.write(c);
maruishi 0:9bbe50de69d8 23 }
maruishi 0:9bbe50de69d8 24
maruishi 0:9bbe50de69d8 25 /*
maruishi 0:9bbe50de69d8 26 LCDモジュールへのデータの送信(1バイト)
maruishi 0:9bbe50de69d8 27 */
maruishi 0:9bbe50de69d8 28 void lcd_data_write(unsigned char c)
maruishi 0:9bbe50de69d8 29 {
maruishi 0:9bbe50de69d8 30 lcd_rs1 = 1;
maruishi 0:9bbe50de69d8 31 spi.write(c);
maruishi 0:9bbe50de69d8 32 }
maruishi 0:9bbe50de69d8 33
maruishi 0:9bbe50de69d8 34 /*
maruishi 0:9bbe50de69d8 35 LCDモジュールへのデータの送信(lenバイト)
maruishi 0:9bbe50de69d8 36 */
maruishi 0:9bbe50de69d8 37 void lcd_writeData(unsigned char* buff,int len)
maruishi 0:9bbe50de69d8 38 {
maruishi 0:9bbe50de69d8 39 int i;
maruishi 0:9bbe50de69d8 40 lcd_rs1 = 1;
maruishi 0:9bbe50de69d8 41 for(i=0; i<len; i++) {
maruishi 0:9bbe50de69d8 42 spi.write(*(buff+i));
maruishi 0:9bbe50de69d8 43 }
maruishi 0:9bbe50de69d8 44 }
maruishi 0:9bbe50de69d8 45
maruishi 0:9bbe50de69d8 46 /*
maruishi 0:9bbe50de69d8 47 LCDモジュールの初期化処理
maruishi 0:9bbe50de69d8 48 */
maruishi 0:9bbe50de69d8 49 void lcd_controllerInitial()
maruishi 0:9bbe50de69d8 50 {
maruishi 0:9bbe50de69d8 51 int i;
maruishi 0:9bbe50de69d8 52
maruishi 0:9bbe50de69d8 53 /*
maruishi 0:9bbe50de69d8 54 LCD初期化用データ
maruishi 0:9bbe50de69d8 55 cmd : true = コマンド
maruishi 0:9bbe50de69d8 56 false = データ
maruishi 0:9bbe50de69d8 57 data : 送出する内容
maruishi 0:9bbe50de69d8 58 */
maruishi 0:9bbe50de69d8 59 const struct lcd_init_data {
maruishi 0:9bbe50de69d8 60 bool cmd;
maruishi 0:9bbe50de69d8 61 unsigned char data;
maruishi 0:9bbe50de69d8 62 } lcd_init_data_table[] = {
maruishi 0:9bbe50de69d8 63 { true, 0xB1 }, // FRMCTR1
maruishi 0:9bbe50de69d8 64 { false, 0x01 },
maruishi 0:9bbe50de69d8 65 { false, 0x2C },
maruishi 0:9bbe50de69d8 66 { false, 0x2D },
maruishi 0:9bbe50de69d8 67
maruishi 0:9bbe50de69d8 68 { true, 0xB2 }, // FRMCTR2
maruishi 0:9bbe50de69d8 69 { false, 0x01 },
maruishi 0:9bbe50de69d8 70 { false, 0x2C },
maruishi 0:9bbe50de69d8 71 { false, 0x2D },
maruishi 0:9bbe50de69d8 72
maruishi 0:9bbe50de69d8 73 { true, 0xB3 }, // FRMCTR3
maruishi 0:9bbe50de69d8 74 { false, 0x01 },
maruishi 0:9bbe50de69d8 75 { false, 0x2C },
maruishi 0:9bbe50de69d8 76 { false, 0x2D },
maruishi 0:9bbe50de69d8 77 { false, 0x01 },
maruishi 0:9bbe50de69d8 78 { false, 0x2C },
maruishi 0:9bbe50de69d8 79 { false, 0x2D },
maruishi 0:9bbe50de69d8 80
maruishi 0:9bbe50de69d8 81 { true, 0xB4 }, // INVCTR
maruishi 0:9bbe50de69d8 82 { false, 0x07 },
maruishi 0:9bbe50de69d8 83
maruishi 0:9bbe50de69d8 84 { true, 0xC0 }, // PWCTR1
maruishi 0:9bbe50de69d8 85 { false, 0xA2 },
maruishi 0:9bbe50de69d8 86 { false, 0x02 },
maruishi 0:9bbe50de69d8 87 { false, 0x84 },
maruishi 0:9bbe50de69d8 88
maruishi 0:9bbe50de69d8 89 { true, 0xC1 }, // PWCTR2
maruishi 0:9bbe50de69d8 90 { false, 0xC5 },
maruishi 0:9bbe50de69d8 91
maruishi 0:9bbe50de69d8 92 { true, 0xC2 }, // PWCTR3
maruishi 0:9bbe50de69d8 93 { false, 0x0A },
maruishi 0:9bbe50de69d8 94 { false, 0x00 },
maruishi 0:9bbe50de69d8 95
maruishi 0:9bbe50de69d8 96 { true, 0xC3 }, // PWCTR4
maruishi 0:9bbe50de69d8 97 { false, 0x8A },
maruishi 0:9bbe50de69d8 98 { false, 0x2A },
maruishi 0:9bbe50de69d8 99
maruishi 0:9bbe50de69d8 100 { true, 0xC4 }, // PWCTR5
maruishi 0:9bbe50de69d8 101 { false, 0x8A },
maruishi 0:9bbe50de69d8 102 { false, 0xEE },
maruishi 0:9bbe50de69d8 103
maruishi 0:9bbe50de69d8 104 { true, 0xC5 }, // VMCTR1
maruishi 0:9bbe50de69d8 105 { false, 0x0E },
maruishi 0:9bbe50de69d8 106
maruishi 0:9bbe50de69d8 107 { true, 0x36 },
maruishi 0:9bbe50de69d8 108 { false, 0xA8 },
maruishi 0:9bbe50de69d8 109
maruishi 0:9bbe50de69d8 110 { true, 0xe0 }, // GAMCTRP1
maruishi 0:9bbe50de69d8 111 { false, 0x02 },
maruishi 0:9bbe50de69d8 112 { false, 0x1c },
maruishi 0:9bbe50de69d8 113 { false, 0x07 },
maruishi 0:9bbe50de69d8 114 { false, 0x12 },
maruishi 0:9bbe50de69d8 115 { false, 0x37 },
maruishi 0:9bbe50de69d8 116 { false, 0x32 },
maruishi 0:9bbe50de69d8 117 { false, 0x29 },
maruishi 0:9bbe50de69d8 118 { false, 0x2d },
maruishi 0:9bbe50de69d8 119 { false, 0x29 },
maruishi 0:9bbe50de69d8 120 { false, 0x25 },
maruishi 0:9bbe50de69d8 121 { false, 0x2b },
maruishi 0:9bbe50de69d8 122 { false, 0x39 },
maruishi 0:9bbe50de69d8 123 { false, 0x00 },
maruishi 0:9bbe50de69d8 124 { false, 0x01 },
maruishi 0:9bbe50de69d8 125 { false, 0x03 },
maruishi 0:9bbe50de69d8 126 { false, 0x10 },
maruishi 0:9bbe50de69d8 127
maruishi 0:9bbe50de69d8 128 { true, 0xe1 },
maruishi 0:9bbe50de69d8 129 { false, 0x03 },
maruishi 0:9bbe50de69d8 130 { false, 0x1d },
maruishi 0:9bbe50de69d8 131 { false, 0x07 },
maruishi 0:9bbe50de69d8 132 { false, 0x06 },
maruishi 0:9bbe50de69d8 133 { false, 0x2e },
maruishi 0:9bbe50de69d8 134 { false, 0x2c },
maruishi 0:9bbe50de69d8 135 { false, 0x29 },
maruishi 0:9bbe50de69d8 136 { false, 0x2d },
maruishi 0:9bbe50de69d8 137 { false, 0x2e },
maruishi 0:9bbe50de69d8 138 { false, 0x2e },
maruishi 0:9bbe50de69d8 139 { false, 0x37 },
maruishi 0:9bbe50de69d8 140 { false, 0x3f },
maruishi 0:9bbe50de69d8 141 { false, 0x00 },
maruishi 0:9bbe50de69d8 142 { false, 0x00 },
maruishi 0:9bbe50de69d8 143 { false, 0x02 },
maruishi 0:9bbe50de69d8 144 { false, 0x10 },
maruishi 0:9bbe50de69d8 145
maruishi 0:9bbe50de69d8 146 { true, 0x2a }, // CASET
maruishi 0:9bbe50de69d8 147 { false, 0x00 },
maruishi 0:9bbe50de69d8 148 { false, 0x01 },
maruishi 0:9bbe50de69d8 149 { false, 0x00 },
maruishi 0:9bbe50de69d8 150 { false, 0xA0 },
maruishi 0:9bbe50de69d8 151
maruishi 0:9bbe50de69d8 152 { true, 0x2b }, // RASET
maruishi 0:9bbe50de69d8 153 { false, 0x00 },
maruishi 0:9bbe50de69d8 154 { false, 0x02 },
maruishi 0:9bbe50de69d8 155 { false, 0x00 },
maruishi 0:9bbe50de69d8 156 { false, 0x81 },
maruishi 0:9bbe50de69d8 157
maruishi 0:9bbe50de69d8 158 { true, 0x3A },
maruishi 0:9bbe50de69d8 159 { false, 0x05 }, // 16bit/pixel
maruishi 0:9bbe50de69d8 160 { true, 0x29 },
maruishi 0:9bbe50de69d8 161 };
maruishi 0:9bbe50de69d8 162
maruishi 0:9bbe50de69d8 163 lcd_rs1 = 0;
maruishi 0:9bbe50de69d8 164 lcd_cs1 = 0;
maruishi 0:9bbe50de69d8 165 lcd_cs2 = 0;
maruishi 0:9bbe50de69d8 166
maruishi 0:9bbe50de69d8 167 spi.write(0x11);
maruishi 0:9bbe50de69d8 168 wait(0.120);
maruishi 0:9bbe50de69d8 169
maruishi 0:9bbe50de69d8 170 for(i=0; i<sizeof(lcd_init_data_table)/sizeof(lcd_init_data_table[0]); i++) {
maruishi 0:9bbe50de69d8 171 if (lcd_init_data_table[i].cmd == true) {
maruishi 0:9bbe50de69d8 172 lcd_rs1 = 0;
maruishi 0:9bbe50de69d8 173 spi.write(lcd_init_data_table[i].data);
maruishi 0:9bbe50de69d8 174 } else {
maruishi 0:9bbe50de69d8 175 lcd_rs1 = 1;
maruishi 0:9bbe50de69d8 176 spi.write(lcd_init_data_table[i].data);
maruishi 0:9bbe50de69d8 177 }
maruishi 0:9bbe50de69d8 178 }
maruishi 0:9bbe50de69d8 179 wait(0.120);
maruishi 0:9bbe50de69d8 180 lcd_cs1 = 1;
maruishi 0:9bbe50de69d8 181 lcd_cs2 = 1;
maruishi 0:9bbe50de69d8 182 }
maruishi 0:9bbe50de69d8 183
maruishi 0:9bbe50de69d8 184 void LCD_updateDisplay(int displayNo,unsigned char* buff)
maruishi 0:9bbe50de69d8 185 {
maruishi 0:9bbe50de69d8 186 if (displayNo == 0) {
maruishi 0:9bbe50de69d8 187 lcd_cs1 = 0;
maruishi 0:9bbe50de69d8 188 } else {
maruishi 0:9bbe50de69d8 189 lcd_cs2 = 0;
maruishi 0:9bbe50de69d8 190 }
maruishi 0:9bbe50de69d8 191 lcd_command_write(0x2C);
maruishi 0:9bbe50de69d8 192 lcd_data_write(0);
maruishi 0:9bbe50de69d8 193 lcd_writeData((unsigned char*)buff,128*160*2);
maruishi 0:9bbe50de69d8 194 lcd_cs1 = 1;
maruishi 0:9bbe50de69d8 195 lcd_cs2 = 1;
maruishi 0:9bbe50de69d8 196 }
maruishi 0:9bbe50de69d8 197
maruishi 0:9bbe50de69d8 198 /*
maruishi 0:9bbe50de69d8 199 LCD位置調整用の十字線表示を行う
maruishi 0:9bbe50de69d8 200 */
maruishi 0:9bbe50de69d8 201 void adjustScreen()
maruishi 0:9bbe50de69d8 202 {
maruishi 0:9bbe50de69d8 203 unsigned char fb[128*160*2];
maruishi 0:9bbe50de69d8 204 int i;
maruishi 0:9bbe50de69d8 205
maruishi 0:9bbe50de69d8 206 memset(fb,0,sizeof(fb));
maruishi 0:9bbe50de69d8 207 for(i=0; i<128; i++) {
maruishi 0:9bbe50de69d8 208 fb[(80 + i*160)*2 ] = 0xff;
maruishi 0:9bbe50de69d8 209 fb[(80 + i*160)*2 + 1] = 0xff;
maruishi 0:9bbe50de69d8 210 }
maruishi 0:9bbe50de69d8 211 for(i=0; i<160; i++) {
maruishi 0:9bbe50de69d8 212 fb[(160*64 + i)*2 ] = 0xff;
maruishi 0:9bbe50de69d8 213 fb[(160*64 + i)*2 + 1] = 0xff;
maruishi 0:9bbe50de69d8 214 }
maruishi 0:9bbe50de69d8 215 LCD_updateDisplay(0,fb);
maruishi 0:9bbe50de69d8 216 LCD_updateDisplay(1,fb);
maruishi 0:9bbe50de69d8 217 while(1);
maruishi 0:9bbe50de69d8 218 }
maruishi 0:9bbe50de69d8 219
maruishi 0:9bbe50de69d8 220 int main()
maruishi 0:9bbe50de69d8 221 {
maruishi 0:9bbe50de69d8 222 unsigned char fb[2][128*160*2];
maruishi 0:9bbe50de69d8 223 FILE *fp;
maruishi 0:9bbe50de69d8 224 int size;
maruishi 0:9bbe50de69d8 225
maruishi 0:9bbe50de69d8 226 pc.baud(115200);
maruishi 0:9bbe50de69d8 227
maruishi 0:9bbe50de69d8 228 /* LCD制御用のSPI初期設定 */
maruishi 0:9bbe50de69d8 229 spi.format(8,0);
maruishi 0:9bbe50de69d8 230 spi.frequency(15000000);
maruishi 0:9bbe50de69d8 231
maruishi 0:9bbe50de69d8 232 /* LCDモジュールのリセット */
maruishi 0:9bbe50de69d8 233 lcd_rst = 0;
maruishi 0:9bbe50de69d8 234 wait(0.1);
maruishi 0:9bbe50de69d8 235 lcd_rst = 1;
maruishi 0:9bbe50de69d8 236 wait(0.1);
maruishi 0:9bbe50de69d8 237
maruishi 0:9bbe50de69d8 238 lcd_cs1 = 1;
maruishi 0:9bbe50de69d8 239 lcd_cs2 = 1;
maruishi 0:9bbe50de69d8 240
maruishi 0:9bbe50de69d8 241 /* LCDモジュールの初期化処理の呼び出し */
maruishi 0:9bbe50de69d8 242 lcd_controllerInitial();
maruishi 0:9bbe50de69d8 243
maruishi 0:9bbe50de69d8 244 if(push_sw == 1) {
maruishi 0:9bbe50de69d8 245 /* 起動時にSW2が押されていない場合は、SDカードからのビデオ再生を実行 */
maruishi 0:9bbe50de69d8 246
maruishi 0:9bbe50de69d8 247 /* ビデオファイルのオープン */
maruishi 0:9bbe50de69d8 248 fp = fopen("/sd/video.rgb", "r");
maruishi 0:9bbe50de69d8 249
maruishi 0:9bbe50de69d8 250 while (true) {
maruishi 0:9bbe50de69d8 251 size = fread(fb, sizeof(char), 128*160*2*2, fp);
maruishi 0:9bbe50de69d8 252 if(size == 128*160*2*2) {
maruishi 0:9bbe50de69d8 253 myled = !myled;
maruishi 0:9bbe50de69d8 254 LCD_updateDisplay(0,fb[0]);
maruishi 0:9bbe50de69d8 255 LCD_updateDisplay(1,fb[1]);
maruishi 0:9bbe50de69d8 256 } else {
maruishi 0:9bbe50de69d8 257 /* 指定したサイズがリード出来ない場合には、ファイル終端と判断 */
maruishi 0:9bbe50de69d8 258 fseek(fp,0L,SEEK_SET);
maruishi 0:9bbe50de69d8 259 }
maruishi 0:9bbe50de69d8 260
maruishi 0:9bbe50de69d8 261 /* もしSW2が押されていたら、ファイルをクローズし、LCDを黒画像にする */
maruishi 0:9bbe50de69d8 262 if(push_sw == 0){
maruishi 0:9bbe50de69d8 263 fclose(fp);
maruishi 0:9bbe50de69d8 264 memset(fb[0],0,sizeof(fb[0]));
maruishi 0:9bbe50de69d8 265 LCD_updateDisplay(0,fb[0]);
maruishi 0:9bbe50de69d8 266 LCD_updateDisplay(1,fb[0]);
maruishi 0:9bbe50de69d8 267 while(1);
maruishi 0:9bbe50de69d8 268 }
maruishi 0:9bbe50de69d8 269 }
maruishi 0:9bbe50de69d8 270 } else {
maruishi 0:9bbe50de69d8 271 /* 起動時にSW2が押されている場合は、LCD調整画面を表示 */
maruishi 0:9bbe50de69d8 272 adjustScreen();
maruishi 0:9bbe50de69d8 273 }
maruishi 0:9bbe50de69d8 274
maruishi 0:9bbe50de69d8 275 }