Sample code of section 10 in Nov 2014 issue of the Interface Magazine, published by CQ publishing in Japan. CQ出版社インターフェース誌 2014年11月号10章に掲載のサンプルコードです. LPC1768にトラ技OV7670モジュールを接続したうえで,省メモリ画像処理(色による簡易顔検出)を行う事例です.画像フレームバッファを確保できないとき,ストリーム処理で画像を加工するのがテーマです.このコードのうちカメラ制御部には,Sadaei Osakabe氏のコードを流用させていただいています.
ov7670.h@0:d2c78848026d, 2014-09-24 (annotated)
- Committer:
- smorioka
- Date:
- Wed Sep 24 20:48:23 2014 +0000
- Revision:
- 0:d2c78848026d
First release;
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
smorioka | 0:d2c78848026d | 1 | // This code was written by Mr.Sadaei Osakabe. |
smorioka | 0:d2c78848026d | 2 | // Original code is located at |
smorioka | 0:d2c78848026d | 3 | // https://mbed.org/users/diasea/code/OV7670_with_AL422B_Color_Size_test/ |
smorioka | 0:d2c78848026d | 4 | |
smorioka | 0:d2c78848026d | 5 | #include "mbed.h" |
smorioka | 0:d2c78848026d | 6 | #include "ov7670reg.h" |
smorioka | 0:d2c78848026d | 7 | |
smorioka | 0:d2c78848026d | 8 | #define OV7670_WRITE (0x42) |
smorioka | 0:d2c78848026d | 9 | #define OV7670_READ (0x43) |
smorioka | 0:d2c78848026d | 10 | #define OV7670_WRITEWAIT (20) |
smorioka | 0:d2c78848026d | 11 | #define OV7670_NOACK (0) |
smorioka | 0:d2c78848026d | 12 | #define OV7670_REGMAX (201) |
smorioka | 0:d2c78848026d | 13 | #define OV7670_I2CFREQ (50000) |
smorioka | 0:d2c78848026d | 14 | |
smorioka | 0:d2c78848026d | 15 | // |
smorioka | 0:d2c78848026d | 16 | // OV7670 + FIFO AL422B camera board test |
smorioka | 0:d2c78848026d | 17 | // |
smorioka | 0:d2c78848026d | 18 | class OV7670 |
smorioka | 0:d2c78848026d | 19 | { |
smorioka | 0:d2c78848026d | 20 | public: |
smorioka | 0:d2c78848026d | 21 | I2C camera; |
smorioka | 0:d2c78848026d | 22 | InterruptIn vsync,href; |
smorioka | 0:d2c78848026d | 23 | DigitalOut wen; |
smorioka | 0:d2c78848026d | 24 | BusIn data; |
smorioka | 0:d2c78848026d | 25 | DigitalOut rrst,oe,rclk; |
smorioka | 0:d2c78848026d | 26 | volatile int LineCounter; |
smorioka | 0:d2c78848026d | 27 | volatile int LastLines; |
smorioka | 0:d2c78848026d | 28 | volatile bool CaptureReq; |
smorioka | 0:d2c78848026d | 29 | volatile bool Busy; |
smorioka | 0:d2c78848026d | 30 | volatile bool Done; |
smorioka | 0:d2c78848026d | 31 | |
smorioka | 0:d2c78848026d | 32 | OV7670( |
smorioka | 0:d2c78848026d | 33 | PinName sda,// Camera I2C port |
smorioka | 0:d2c78848026d | 34 | PinName scl,// Camera I2C port |
smorioka | 0:d2c78848026d | 35 | PinName vs, // VSYNC |
smorioka | 0:d2c78848026d | 36 | PinName hr, // HREF |
smorioka | 0:d2c78848026d | 37 | PinName we, // WEN |
smorioka | 0:d2c78848026d | 38 | PinName d7, // D7 |
smorioka | 0:d2c78848026d | 39 | PinName d6, // D6 |
smorioka | 0:d2c78848026d | 40 | PinName d5, // D5 |
smorioka | 0:d2c78848026d | 41 | PinName d4, // D4 |
smorioka | 0:d2c78848026d | 42 | PinName d3, // D3 |
smorioka | 0:d2c78848026d | 43 | PinName d2, // D2 |
smorioka | 0:d2c78848026d | 44 | PinName d1, // D1 |
smorioka | 0:d2c78848026d | 45 | PinName d0, // D0 |
smorioka | 0:d2c78848026d | 46 | PinName rt, // /RRST |
smorioka | 0:d2c78848026d | 47 | PinName o, // /OE |
smorioka | 0:d2c78848026d | 48 | PinName rc // RCLK |
smorioka | 0:d2c78848026d | 49 | ) : camera(sda,scl),vsync(vs),href(hr),wen(we),data(d0,d1,d2,d3,d4,d5,d6,d7),rrst(rt),oe(o),rclk(rc) |
smorioka | 0:d2c78848026d | 50 | { |
smorioka | 0:d2c78848026d | 51 | camera.stop(); |
smorioka | 0:d2c78848026d | 52 | camera.frequency(OV7670_I2CFREQ); |
smorioka | 0:d2c78848026d | 53 | vsync.fall(this,&OV7670::VsyncHandler); |
smorioka | 0:d2c78848026d | 54 | href.rise(this,&OV7670::HrefHandler); |
smorioka | 0:d2c78848026d | 55 | CaptureReq = false; |
smorioka | 0:d2c78848026d | 56 | Busy = false; |
smorioka | 0:d2c78848026d | 57 | Done = false; |
smorioka | 0:d2c78848026d | 58 | LineCounter = 0; |
smorioka | 0:d2c78848026d | 59 | rrst = 1; |
smorioka | 0:d2c78848026d | 60 | oe = 1; |
smorioka | 0:d2c78848026d | 61 | rclk = 1; |
smorioka | 0:d2c78848026d | 62 | wen = 0; |
smorioka | 0:d2c78848026d | 63 | } |
smorioka | 0:d2c78848026d | 64 | |
smorioka | 0:d2c78848026d | 65 | // capture request |
smorioka | 0:d2c78848026d | 66 | void CaptureNext(void) |
smorioka | 0:d2c78848026d | 67 | { |
smorioka | 0:d2c78848026d | 68 | CaptureReq = true; |
smorioka | 0:d2c78848026d | 69 | Busy = true; |
smorioka | 0:d2c78848026d | 70 | } |
smorioka | 0:d2c78848026d | 71 | |
smorioka | 0:d2c78848026d | 72 | // capture done? (with clear) |
smorioka | 0:d2c78848026d | 73 | bool CaptureDone(void) |
smorioka | 0:d2c78848026d | 74 | { |
smorioka | 0:d2c78848026d | 75 | bool result; |
smorioka | 0:d2c78848026d | 76 | if (Busy) { |
smorioka | 0:d2c78848026d | 77 | result = false; |
smorioka | 0:d2c78848026d | 78 | } else { |
smorioka | 0:d2c78848026d | 79 | result = Done; |
smorioka | 0:d2c78848026d | 80 | Done = false; |
smorioka | 0:d2c78848026d | 81 | } |
smorioka | 0:d2c78848026d | 82 | return result; |
smorioka | 0:d2c78848026d | 83 | } |
smorioka | 0:d2c78848026d | 84 | |
smorioka | 0:d2c78848026d | 85 | // write to camera |
smorioka | 0:d2c78848026d | 86 | void WriteReg(int addr,int data) |
smorioka | 0:d2c78848026d | 87 | { |
smorioka | 0:d2c78848026d | 88 | // WRITE 0x42,ADDR,DATA |
smorioka | 0:d2c78848026d | 89 | camera.start(); |
smorioka | 0:d2c78848026d | 90 | camera.write(OV7670_WRITE); |
smorioka | 0:d2c78848026d | 91 | wait_us(OV7670_WRITEWAIT); |
smorioka | 0:d2c78848026d | 92 | camera.write(addr); |
smorioka | 0:d2c78848026d | 93 | wait_us(OV7670_WRITEWAIT); |
smorioka | 0:d2c78848026d | 94 | camera.write(data); |
smorioka | 0:d2c78848026d | 95 | camera.stop(); |
smorioka | 0:d2c78848026d | 96 | } |
smorioka | 0:d2c78848026d | 97 | |
smorioka | 0:d2c78848026d | 98 | // read from camera |
smorioka | 0:d2c78848026d | 99 | int ReadReg(int addr) |
smorioka | 0:d2c78848026d | 100 | { |
smorioka | 0:d2c78848026d | 101 | int data; |
smorioka | 0:d2c78848026d | 102 | |
smorioka | 0:d2c78848026d | 103 | // WRITE 0x42,ADDR |
smorioka | 0:d2c78848026d | 104 | camera.start(); |
smorioka | 0:d2c78848026d | 105 | camera.write(OV7670_WRITE); |
smorioka | 0:d2c78848026d | 106 | wait_us(OV7670_WRITEWAIT); |
smorioka | 0:d2c78848026d | 107 | camera.write(addr); |
smorioka | 0:d2c78848026d | 108 | camera.stop(); |
smorioka | 0:d2c78848026d | 109 | wait_us(OV7670_WRITEWAIT); |
smorioka | 0:d2c78848026d | 110 | |
smorioka | 0:d2c78848026d | 111 | // WRITE 0x43,READ |
smorioka | 0:d2c78848026d | 112 | camera.start(); |
smorioka | 0:d2c78848026d | 113 | camera.write(OV7670_READ); |
smorioka | 0:d2c78848026d | 114 | wait_us(OV7670_WRITEWAIT); |
smorioka | 0:d2c78848026d | 115 | data = camera.read(OV7670_NOACK); |
smorioka | 0:d2c78848026d | 116 | camera.stop(); |
smorioka | 0:d2c78848026d | 117 | |
smorioka | 0:d2c78848026d | 118 | return data; |
smorioka | 0:d2c78848026d | 119 | } |
smorioka | 0:d2c78848026d | 120 | |
smorioka | 0:d2c78848026d | 121 | // print register |
smorioka | 0:d2c78848026d | 122 | void PrintRegister(void) { |
smorioka | 0:d2c78848026d | 123 | printf("AD : +0 +1 +2 +3 +4 +5 +6 +7 +8 +9 +A +B +C +D +E +F"); |
smorioka | 0:d2c78848026d | 124 | for (int i=0;i<OV7670_REGMAX;i++) { |
smorioka | 0:d2c78848026d | 125 | int data; |
smorioka | 0:d2c78848026d | 126 | data = ReadReg(i); // READ REG |
smorioka | 0:d2c78848026d | 127 | if ((i & 0x0F) == 0) { |
smorioka | 0:d2c78848026d | 128 | printf("\r\n%02X : ",i); |
smorioka | 0:d2c78848026d | 129 | } |
smorioka | 0:d2c78848026d | 130 | printf("%02X ",data); |
smorioka | 0:d2c78848026d | 131 | } |
smorioka | 0:d2c78848026d | 132 | printf("\r\n"); |
smorioka | 0:d2c78848026d | 133 | } |
smorioka | 0:d2c78848026d | 134 | |
smorioka | 0:d2c78848026d | 135 | void Reset(void) { |
smorioka | 0:d2c78848026d | 136 | WriteReg(REG_COM7,COM7_RESET); // RESET CAMERA |
smorioka | 0:d2c78848026d | 137 | wait_ms(200); |
smorioka | 0:d2c78848026d | 138 | } |
smorioka | 0:d2c78848026d | 139 | |
smorioka | 0:d2c78848026d | 140 | void InitForFIFOWriteReset(void) { |
smorioka | 0:d2c78848026d | 141 | WriteReg(REG_COM10, COM10_VS_NEG); |
smorioka | 0:d2c78848026d | 142 | } |
smorioka | 0:d2c78848026d | 143 | |
smorioka | 0:d2c78848026d | 144 | void InitSetColorbar(void) { |
smorioka | 0:d2c78848026d | 145 | int reg_com7 = ReadReg(REG_COM7); |
smorioka | 0:d2c78848026d | 146 | // color bar |
smorioka | 0:d2c78848026d | 147 | WriteReg(REG_COM17, reg_com7|COM17_CBAR); |
smorioka | 0:d2c78848026d | 148 | } |
smorioka | 0:d2c78848026d | 149 | |
smorioka | 0:d2c78848026d | 150 | void InitDefaultReg(void) { |
smorioka | 0:d2c78848026d | 151 | // Gamma curve values |
smorioka | 0:d2c78848026d | 152 | WriteReg(0x7a, 0x20); |
smorioka | 0:d2c78848026d | 153 | WriteReg(0x7b, 0x10); |
smorioka | 0:d2c78848026d | 154 | WriteReg(0x7c, 0x1e); |
smorioka | 0:d2c78848026d | 155 | WriteReg(0x7d, 0x35); |
smorioka | 0:d2c78848026d | 156 | WriteReg(0x7e, 0x5a); |
smorioka | 0:d2c78848026d | 157 | WriteReg(0x7f, 0x69); |
smorioka | 0:d2c78848026d | 158 | WriteReg(0x80, 0x76); |
smorioka | 0:d2c78848026d | 159 | WriteReg(0x81, 0x80); |
smorioka | 0:d2c78848026d | 160 | WriteReg(0x82, 0x88); |
smorioka | 0:d2c78848026d | 161 | WriteReg(0x83, 0x8f); |
smorioka | 0:d2c78848026d | 162 | WriteReg(0x84, 0x96); |
smorioka | 0:d2c78848026d | 163 | WriteReg(0x85, 0xa3); |
smorioka | 0:d2c78848026d | 164 | WriteReg(0x86, 0xaf); |
smorioka | 0:d2c78848026d | 165 | WriteReg(0x87, 0xc4); |
smorioka | 0:d2c78848026d | 166 | WriteReg(0x88, 0xd7); |
smorioka | 0:d2c78848026d | 167 | WriteReg(0x89, 0xe8); |
smorioka | 0:d2c78848026d | 168 | |
smorioka | 0:d2c78848026d | 169 | // AGC and AEC parameters. Note we start by disabling those features, |
smorioka | 0:d2c78848026d | 170 | //then turn them only after tweaking the values. |
smorioka | 0:d2c78848026d | 171 | WriteReg(REG_COM8, COM8_FASTAEC | COM8_AECSTEP | COM8_BFILT); |
smorioka | 0:d2c78848026d | 172 | WriteReg(REG_GAIN, 0); |
smorioka | 0:d2c78848026d | 173 | WriteReg(REG_AECH, 0); |
smorioka | 0:d2c78848026d | 174 | WriteReg(REG_COM4, 0x40); |
smorioka | 0:d2c78848026d | 175 | // magic reserved bit |
smorioka | 0:d2c78848026d | 176 | WriteReg(REG_COM9, 0x18); |
smorioka | 0:d2c78848026d | 177 | // 4x gain + magic rsvd bit |
smorioka | 0:d2c78848026d | 178 | WriteReg(REG_BD50MAX, 0x05); |
smorioka | 0:d2c78848026d | 179 | WriteReg(REG_BD60MAX, 0x07); |
smorioka | 0:d2c78848026d | 180 | WriteReg(REG_AEW, 0x95); |
smorioka | 0:d2c78848026d | 181 | WriteReg(REG_AEB, 0x33); |
smorioka | 0:d2c78848026d | 182 | WriteReg(REG_VPT, 0xe3); |
smorioka | 0:d2c78848026d | 183 | WriteReg(REG_HAECC1, 0x78); |
smorioka | 0:d2c78848026d | 184 | WriteReg(REG_HAECC2, 0x68); |
smorioka | 0:d2c78848026d | 185 | WriteReg(0xa1, 0x03); |
smorioka | 0:d2c78848026d | 186 | // magic |
smorioka | 0:d2c78848026d | 187 | WriteReg(REG_HAECC3, 0xd8); |
smorioka | 0:d2c78848026d | 188 | WriteReg(REG_HAECC4, 0xd8); |
smorioka | 0:d2c78848026d | 189 | WriteReg(REG_HAECC5, 0xf0); |
smorioka | 0:d2c78848026d | 190 | WriteReg(REG_HAECC6, 0x90); |
smorioka | 0:d2c78848026d | 191 | WriteReg(REG_HAECC7, 0x94); |
smorioka | 0:d2c78848026d | 192 | WriteReg(REG_COM8, COM8_FASTAEC|COM8_AECSTEP|COM8_BFILT|COM8_AGC|COM8_AEC); |
smorioka | 0:d2c78848026d | 193 | |
smorioka | 0:d2c78848026d | 194 | // Almost all of these are magic "reserved" values. |
smorioka | 0:d2c78848026d | 195 | WriteReg(REG_COM5, 0x61); |
smorioka | 0:d2c78848026d | 196 | WriteReg(REG_COM6, 0x4b); |
smorioka | 0:d2c78848026d | 197 | WriteReg(0x16, 0x02); |
smorioka | 0:d2c78848026d | 198 | WriteReg(REG_MVFP, 0x07); |
smorioka | 0:d2c78848026d | 199 | WriteReg(0x21, 0x02); |
smorioka | 0:d2c78848026d | 200 | WriteReg(0x22, 0x91); |
smorioka | 0:d2c78848026d | 201 | WriteReg(0x29, 0x07); |
smorioka | 0:d2c78848026d | 202 | WriteReg(0x33, 0x0b); |
smorioka | 0:d2c78848026d | 203 | WriteReg(0x35, 0x0b); |
smorioka | 0:d2c78848026d | 204 | WriteReg(0x37, 0x1d); |
smorioka | 0:d2c78848026d | 205 | WriteReg(0x38, 0x71); |
smorioka | 0:d2c78848026d | 206 | WriteReg(0x39, 0x2a); |
smorioka | 0:d2c78848026d | 207 | WriteReg(REG_COM12, 0x78); |
smorioka | 0:d2c78848026d | 208 | WriteReg(0x4d, 0x40); |
smorioka | 0:d2c78848026d | 209 | WriteReg(0x4e, 0x20); |
smorioka | 0:d2c78848026d | 210 | WriteReg(REG_GFIX, 0); |
smorioka | 0:d2c78848026d | 211 | WriteReg(0x6b, 0x0a); |
smorioka | 0:d2c78848026d | 212 | WriteReg(0x74, 0x10); |
smorioka | 0:d2c78848026d | 213 | WriteReg(0x8d, 0x4f); |
smorioka | 0:d2c78848026d | 214 | WriteReg(0x8e, 0); |
smorioka | 0:d2c78848026d | 215 | WriteReg(0x8f, 0); |
smorioka | 0:d2c78848026d | 216 | WriteReg(0x90, 0); |
smorioka | 0:d2c78848026d | 217 | WriteReg(0x91, 0); |
smorioka | 0:d2c78848026d | 218 | WriteReg(0x96, 0); |
smorioka | 0:d2c78848026d | 219 | WriteReg(0x9a, 0); |
smorioka | 0:d2c78848026d | 220 | WriteReg(0xb0, 0x84); |
smorioka | 0:d2c78848026d | 221 | WriteReg(0xb1, 0x0c); |
smorioka | 0:d2c78848026d | 222 | WriteReg(0xb2, 0x0e); |
smorioka | 0:d2c78848026d | 223 | WriteReg(0xb3, 0x82); |
smorioka | 0:d2c78848026d | 224 | WriteReg(0xb8, 0x0a); |
smorioka | 0:d2c78848026d | 225 | |
smorioka | 0:d2c78848026d | 226 | // More reserved magic, some of which tweaks white balance |
smorioka | 0:d2c78848026d | 227 | WriteReg(0x43, 0x0a); |
smorioka | 0:d2c78848026d | 228 | WriteReg(0x44, 0xf0); |
smorioka | 0:d2c78848026d | 229 | WriteReg(0x45, 0x34); |
smorioka | 0:d2c78848026d | 230 | WriteReg(0x46, 0x58); |
smorioka | 0:d2c78848026d | 231 | WriteReg(0x47, 0x28); |
smorioka | 0:d2c78848026d | 232 | WriteReg(0x48, 0x3a); |
smorioka | 0:d2c78848026d | 233 | WriteReg(0x59, 0x88); |
smorioka | 0:d2c78848026d | 234 | WriteReg(0x5a, 0x88); |
smorioka | 0:d2c78848026d | 235 | WriteReg(0x5b, 0x44); |
smorioka | 0:d2c78848026d | 236 | WriteReg(0x5c, 0x67); |
smorioka | 0:d2c78848026d | 237 | WriteReg(0x5d, 0x49); |
smorioka | 0:d2c78848026d | 238 | WriteReg(0x5e, 0x0e); |
smorioka | 0:d2c78848026d | 239 | WriteReg(0x6c, 0x0a); |
smorioka | 0:d2c78848026d | 240 | WriteReg(0x6d, 0x55); |
smorioka | 0:d2c78848026d | 241 | WriteReg(0x6e, 0x11); |
smorioka | 0:d2c78848026d | 242 | WriteReg(0x6f, 0x9f); |
smorioka | 0:d2c78848026d | 243 | // "9e for advance AWB" |
smorioka | 0:d2c78848026d | 244 | WriteReg(0x6a, 0x40); |
smorioka | 0:d2c78848026d | 245 | WriteReg(REG_BLUE, 0x40); |
smorioka | 0:d2c78848026d | 246 | WriteReg(REG_RED, 0x60); |
smorioka | 0:d2c78848026d | 247 | WriteReg(REG_COM8, COM8_FASTAEC|COM8_AECSTEP|COM8_BFILT|COM8_AGC|COM8_AEC|COM8_AWB); |
smorioka | 0:d2c78848026d | 248 | |
smorioka | 0:d2c78848026d | 249 | // Matrix coefficients |
smorioka | 0:d2c78848026d | 250 | WriteReg(0x4f, 0x80); |
smorioka | 0:d2c78848026d | 251 | WriteReg(0x50, 0x80); |
smorioka | 0:d2c78848026d | 252 | WriteReg(0x51, 0); |
smorioka | 0:d2c78848026d | 253 | WriteReg(0x52, 0x22); |
smorioka | 0:d2c78848026d | 254 | WriteReg(0x53, 0x5e); |
smorioka | 0:d2c78848026d | 255 | WriteReg(0x54, 0x80); |
smorioka | 0:d2c78848026d | 256 | WriteReg(0x58, 0x9e); |
smorioka | 0:d2c78848026d | 257 | |
smorioka | 0:d2c78848026d | 258 | WriteReg(REG_COM16, COM16_AWBGAIN); |
smorioka | 0:d2c78848026d | 259 | WriteReg(REG_EDGE, 0); |
smorioka | 0:d2c78848026d | 260 | WriteReg(0x75, 0x05); |
smorioka | 0:d2c78848026d | 261 | WriteReg(0x76, 0xe1); |
smorioka | 0:d2c78848026d | 262 | WriteReg(0x4c, 0); |
smorioka | 0:d2c78848026d | 263 | WriteReg(0x77, 0x01); |
smorioka | 0:d2c78848026d | 264 | WriteReg(0x4b, 0x09); |
smorioka | 0:d2c78848026d | 265 | WriteReg(0xc9, 0x60); |
smorioka | 0:d2c78848026d | 266 | WriteReg(REG_COM16, 0x38); |
smorioka | 0:d2c78848026d | 267 | WriteReg(0x56, 0x40); |
smorioka | 0:d2c78848026d | 268 | |
smorioka | 0:d2c78848026d | 269 | WriteReg(0x34, 0x11); |
smorioka | 0:d2c78848026d | 270 | WriteReg(REG_COM11, COM11_EXP|COM11_HZAUTO_ON); |
smorioka | 0:d2c78848026d | 271 | WriteReg(0xa4, 0x88); |
smorioka | 0:d2c78848026d | 272 | WriteReg(0x96, 0); |
smorioka | 0:d2c78848026d | 273 | WriteReg(0x97, 0x30); |
smorioka | 0:d2c78848026d | 274 | WriteReg(0x98, 0x20); |
smorioka | 0:d2c78848026d | 275 | WriteReg(0x99, 0x30); |
smorioka | 0:d2c78848026d | 276 | WriteReg(0x9a, 0x84); |
smorioka | 0:d2c78848026d | 277 | WriteReg(0x9b, 0x29); |
smorioka | 0:d2c78848026d | 278 | WriteReg(0x9c, 0x03); |
smorioka | 0:d2c78848026d | 279 | WriteReg(0x9d, 0x4c); |
smorioka | 0:d2c78848026d | 280 | WriteReg(0x9e, 0x3f); |
smorioka | 0:d2c78848026d | 281 | WriteReg(0x78, 0x04); |
smorioka | 0:d2c78848026d | 282 | |
smorioka | 0:d2c78848026d | 283 | // Extra-weird stuff. Some sort of multiplexor register |
smorioka | 0:d2c78848026d | 284 | WriteReg(0x79, 0x01); |
smorioka | 0:d2c78848026d | 285 | WriteReg(0xc8, 0xf0); |
smorioka | 0:d2c78848026d | 286 | WriteReg(0x79, 0x0f); |
smorioka | 0:d2c78848026d | 287 | WriteReg(0xc8, 0x00); |
smorioka | 0:d2c78848026d | 288 | WriteReg(0x79, 0x10); |
smorioka | 0:d2c78848026d | 289 | WriteReg(0xc8, 0x7e); |
smorioka | 0:d2c78848026d | 290 | WriteReg(0x79, 0x0a); |
smorioka | 0:d2c78848026d | 291 | WriteReg(0xc8, 0x80); |
smorioka | 0:d2c78848026d | 292 | WriteReg(0x79, 0x0b); |
smorioka | 0:d2c78848026d | 293 | WriteReg(0xc8, 0x01); |
smorioka | 0:d2c78848026d | 294 | WriteReg(0x79, 0x0c); |
smorioka | 0:d2c78848026d | 295 | WriteReg(0xc8, 0x0f); |
smorioka | 0:d2c78848026d | 296 | WriteReg(0x79, 0x0d); |
smorioka | 0:d2c78848026d | 297 | WriteReg(0xc8, 0x20); |
smorioka | 0:d2c78848026d | 298 | WriteReg(0x79, 0x09); |
smorioka | 0:d2c78848026d | 299 | WriteReg(0xc8, 0x80); |
smorioka | 0:d2c78848026d | 300 | WriteReg(0x79, 0x02); |
smorioka | 0:d2c78848026d | 301 | WriteReg(0xc8, 0xc0); |
smorioka | 0:d2c78848026d | 302 | WriteReg(0x79, 0x03); |
smorioka | 0:d2c78848026d | 303 | WriteReg(0xc8, 0x40); |
smorioka | 0:d2c78848026d | 304 | WriteReg(0x79, 0x05); |
smorioka | 0:d2c78848026d | 305 | WriteReg(0xc8, 0x30); |
smorioka | 0:d2c78848026d | 306 | WriteReg(0x79, 0x26); |
smorioka | 0:d2c78848026d | 307 | } |
smorioka | 0:d2c78848026d | 308 | |
smorioka | 0:d2c78848026d | 309 | void InitRGB444(void){ |
smorioka | 0:d2c78848026d | 310 | int reg_com7 = ReadReg(REG_COM7); |
smorioka | 0:d2c78848026d | 311 | |
smorioka | 0:d2c78848026d | 312 | WriteReg(REG_COM7, reg_com7|COM7_RGB); |
smorioka | 0:d2c78848026d | 313 | WriteReg(REG_RGB444, RGB444_ENABLE|RGB444_XBGR); |
smorioka | 0:d2c78848026d | 314 | WriteReg(REG_COM15, COM15_R01FE|COM15_RGB444); |
smorioka | 0:d2c78848026d | 315 | |
smorioka | 0:d2c78848026d | 316 | WriteReg(REG_COM1, 0x40); // Magic reserved bit |
smorioka | 0:d2c78848026d | 317 | WriteReg(REG_COM9, 0x38); // 16x gain ceiling; 0x8 is reserved bit |
smorioka | 0:d2c78848026d | 318 | WriteReg(0x4f, 0xb3); // "matrix coefficient 1" |
smorioka | 0:d2c78848026d | 319 | WriteReg(0x50, 0xb3); // "matrix coefficient 2" |
smorioka | 0:d2c78848026d | 320 | WriteReg(0x51, 0x00); // vb |
smorioka | 0:d2c78848026d | 321 | WriteReg(0x52, 0x3d); // "matrix coefficient 4" |
smorioka | 0:d2c78848026d | 322 | WriteReg(0x53, 0xa7); // "matrix coefficient 5" |
smorioka | 0:d2c78848026d | 323 | WriteReg(0x54, 0xe4); // "matrix coefficient 6" |
smorioka | 0:d2c78848026d | 324 | WriteReg(REG_COM13, COM13_GAMMA|COM13_UVSAT|0x2); // Magic rsvd bit |
smorioka | 0:d2c78848026d | 325 | |
smorioka | 0:d2c78848026d | 326 | WriteReg(REG_TSLB, 0x04); |
smorioka | 0:d2c78848026d | 327 | } |
smorioka | 0:d2c78848026d | 328 | |
smorioka | 0:d2c78848026d | 329 | void InitRGB555(void){ |
smorioka | 0:d2c78848026d | 330 | int reg_com7 = ReadReg(REG_COM7); |
smorioka | 0:d2c78848026d | 331 | |
smorioka | 0:d2c78848026d | 332 | WriteReg(REG_COM7, reg_com7|COM7_RGB); |
smorioka | 0:d2c78848026d | 333 | WriteReg(REG_RGB444, RGB444_DISABLE); |
smorioka | 0:d2c78848026d | 334 | WriteReg(REG_COM15, COM15_RGB555|COM15_R00FF); |
smorioka | 0:d2c78848026d | 335 | |
smorioka | 0:d2c78848026d | 336 | WriteReg(REG_TSLB, 0x04); |
smorioka | 0:d2c78848026d | 337 | |
smorioka | 0:d2c78848026d | 338 | WriteReg(REG_COM1, 0x00); |
smorioka | 0:d2c78848026d | 339 | WriteReg(REG_COM9, 0x38); // 16x gain ceiling; 0x8 is reserved bit |
smorioka | 0:d2c78848026d | 340 | WriteReg(0x4f, 0xb3); // "matrix coefficient 1" |
smorioka | 0:d2c78848026d | 341 | WriteReg(0x50, 0xb3); // "matrix coefficient 2" |
smorioka | 0:d2c78848026d | 342 | WriteReg(0x51, 0x00); // vb |
smorioka | 0:d2c78848026d | 343 | WriteReg(0x52, 0x3d); // "matrix coefficient 4" |
smorioka | 0:d2c78848026d | 344 | WriteReg(0x53, 0xa7); // "matrix coefficient 5" |
smorioka | 0:d2c78848026d | 345 | WriteReg(0x54, 0xe4); // "matrix coefficient 6" |
smorioka | 0:d2c78848026d | 346 | WriteReg(REG_COM13, COM13_GAMMA|COM13_UVSAT); |
smorioka | 0:d2c78848026d | 347 | } |
smorioka | 0:d2c78848026d | 348 | |
smorioka | 0:d2c78848026d | 349 | void InitRGB565(void){ |
smorioka | 0:d2c78848026d | 350 | int reg_com7 = ReadReg(REG_COM7); |
smorioka | 0:d2c78848026d | 351 | |
smorioka | 0:d2c78848026d | 352 | WriteReg(REG_COM7, reg_com7|COM7_RGB); |
smorioka | 0:d2c78848026d | 353 | WriteReg(REG_RGB444, RGB444_DISABLE); |
smorioka | 0:d2c78848026d | 354 | WriteReg(REG_COM15, COM15_R00FF|COM15_RGB565); |
smorioka | 0:d2c78848026d | 355 | |
smorioka | 0:d2c78848026d | 356 | WriteReg(REG_TSLB, 0x04); |
smorioka | 0:d2c78848026d | 357 | |
smorioka | 0:d2c78848026d | 358 | WriteReg(REG_COM1, 0x00); |
smorioka | 0:d2c78848026d | 359 | WriteReg(REG_COM9, 0x38); // 16x gain ceiling; 0x8 is reserved bit |
smorioka | 0:d2c78848026d | 360 | WriteReg(0x4f, 0xb3); // "matrix coefficient 1" |
smorioka | 0:d2c78848026d | 361 | WriteReg(0x50, 0xb3); // "matrix coefficient 2" |
smorioka | 0:d2c78848026d | 362 | WriteReg(0x51, 0x00); // vb |
smorioka | 0:d2c78848026d | 363 | WriteReg(0x52, 0x3d); // "matrix coefficient 4" |
smorioka | 0:d2c78848026d | 364 | WriteReg(0x53, 0xa7); // "matrix coefficient 5" |
smorioka | 0:d2c78848026d | 365 | WriteReg(0x54, 0xe4); // "matrix coefficient 6" |
smorioka | 0:d2c78848026d | 366 | WriteReg(REG_COM13, COM13_GAMMA|COM13_UVSAT); |
smorioka | 0:d2c78848026d | 367 | } |
smorioka | 0:d2c78848026d | 368 | |
smorioka | 0:d2c78848026d | 369 | void InitYUV(void){ |
smorioka | 0:d2c78848026d | 370 | int reg_com7 = ReadReg(REG_COM7); |
smorioka | 0:d2c78848026d | 371 | |
smorioka | 0:d2c78848026d | 372 | WriteReg(REG_COM7, reg_com7|COM7_YUV); |
smorioka | 0:d2c78848026d | 373 | WriteReg(REG_RGB444, RGB444_DISABLE); |
smorioka | 0:d2c78848026d | 374 | WriteReg(REG_COM15, COM15_R00FF); |
smorioka | 0:d2c78848026d | 375 | |
smorioka | 0:d2c78848026d | 376 | WriteReg(REG_TSLB, 0x04); |
smorioka | 0:d2c78848026d | 377 | // WriteReg(REG_TSLB, 0x14); |
smorioka | 0:d2c78848026d | 378 | // WriteReg(REG_MANU, 0x00); |
smorioka | 0:d2c78848026d | 379 | // WriteReg(REG_MANV, 0x00); |
smorioka | 0:d2c78848026d | 380 | |
smorioka | 0:d2c78848026d | 381 | WriteReg(REG_COM1, 0x00); |
smorioka | 0:d2c78848026d | 382 | WriteReg(REG_COM9, 0x18); // 4x gain ceiling; 0x8 is reserved bit |
smorioka | 0:d2c78848026d | 383 | WriteReg(0x4f, 0x80); // "matrix coefficient 1" |
smorioka | 0:d2c78848026d | 384 | WriteReg(0x50, 0x80); // "matrix coefficient 2" |
smorioka | 0:d2c78848026d | 385 | WriteReg(0x51, 0x00); // vb |
smorioka | 0:d2c78848026d | 386 | WriteReg(0x52, 0x22); // "matrix coefficient 4" |
smorioka | 0:d2c78848026d | 387 | WriteReg(0x53, 0x5e); // "matrix coefficient 5" |
smorioka | 0:d2c78848026d | 388 | WriteReg(0x54, 0x80); // "matrix coefficient 6" |
smorioka | 0:d2c78848026d | 389 | WriteReg(REG_COM13, COM13_GAMMA|COM13_UVSAT|COM13_UVSWAP); |
smorioka | 0:d2c78848026d | 390 | } |
smorioka | 0:d2c78848026d | 391 | |
smorioka | 0:d2c78848026d | 392 | void InitBayerRGB(void){ |
smorioka | 0:d2c78848026d | 393 | int reg_com7 = ReadReg(REG_COM7); |
smorioka | 0:d2c78848026d | 394 | |
smorioka | 0:d2c78848026d | 395 | // odd line BGBG... even line GRGR... |
smorioka | 0:d2c78848026d | 396 | WriteReg(REG_COM7, reg_com7|COM7_BAYER); |
smorioka | 0:d2c78848026d | 397 | // odd line GBGB... even line RGRG... |
smorioka | 0:d2c78848026d | 398 | //WriteReg(REG_COM7, reg_com7|COM7_PBAYER); |
smorioka | 0:d2c78848026d | 399 | |
smorioka | 0:d2c78848026d | 400 | WriteReg(REG_RGB444, RGB444_DISABLE); |
smorioka | 0:d2c78848026d | 401 | WriteReg(REG_COM15, COM15_R00FF); |
smorioka | 0:d2c78848026d | 402 | |
smorioka | 0:d2c78848026d | 403 | WriteReg(REG_COM13, 0x08); /* No gamma, magic rsvd bit */ |
smorioka | 0:d2c78848026d | 404 | WriteReg(REG_COM16, 0x3d); /* Edge enhancement, denoise */ |
smorioka | 0:d2c78848026d | 405 | WriteReg(REG_REG76, 0xe1); /* Pix correction, magic rsvd */ |
smorioka | 0:d2c78848026d | 406 | |
smorioka | 0:d2c78848026d | 407 | WriteReg(REG_TSLB, 0x04); |
smorioka | 0:d2c78848026d | 408 | } |
smorioka | 0:d2c78848026d | 409 | |
smorioka | 0:d2c78848026d | 410 | void InitVGA(void) { |
smorioka | 0:d2c78848026d | 411 | // VGA |
smorioka | 0:d2c78848026d | 412 | int reg_com7 = ReadReg(REG_COM7); |
smorioka | 0:d2c78848026d | 413 | |
smorioka | 0:d2c78848026d | 414 | WriteReg(REG_COM7,reg_com7|COM7_VGA); |
smorioka | 0:d2c78848026d | 415 | |
smorioka | 0:d2c78848026d | 416 | WriteReg(REG_HSTART,HSTART_VGA); |
smorioka | 0:d2c78848026d | 417 | WriteReg(REG_HSTOP,HSTOP_VGA); |
smorioka | 0:d2c78848026d | 418 | WriteReg(REG_HREF,HREF_VGA); |
smorioka | 0:d2c78848026d | 419 | WriteReg(REG_VSTART,VSTART_VGA); |
smorioka | 0:d2c78848026d | 420 | WriteReg(REG_VSTOP,VSTOP_VGA); |
smorioka | 0:d2c78848026d | 421 | WriteReg(REG_VREF,VREF_VGA); |
smorioka | 0:d2c78848026d | 422 | WriteReg(REG_COM3, COM3_VGA); |
smorioka | 0:d2c78848026d | 423 | WriteReg(REG_COM14, COM14_VGA); |
smorioka | 0:d2c78848026d | 424 | WriteReg(REG_SCALING_XSC, SCALING_XSC_VGA); |
smorioka | 0:d2c78848026d | 425 | WriteReg(REG_SCALING_YSC, SCALING_YSC_VGA); |
smorioka | 0:d2c78848026d | 426 | WriteReg(REG_SCALING_DCWCTR, SCALING_DCWCTR_VGA); |
smorioka | 0:d2c78848026d | 427 | WriteReg(REG_SCALING_PCLK_DIV, SCALING_PCLK_DIV_VGA); |
smorioka | 0:d2c78848026d | 428 | WriteReg(REG_SCALING_PCLK_DELAY, SCALING_PCLK_DELAY_VGA); |
smorioka | 0:d2c78848026d | 429 | } |
smorioka | 0:d2c78848026d | 430 | |
smorioka | 0:d2c78848026d | 431 | void InitFIFO_2bytes_color_nealy_limit_size(void) { |
smorioka | 0:d2c78848026d | 432 | // nealy FIFO limit 544x360 |
smorioka | 0:d2c78848026d | 433 | int reg_com7 = ReadReg(REG_COM7); |
smorioka | 0:d2c78848026d | 434 | |
smorioka | 0:d2c78848026d | 435 | WriteReg(REG_COM7,reg_com7|COM7_VGA); |
smorioka | 0:d2c78848026d | 436 | |
smorioka | 0:d2c78848026d | 437 | WriteReg(REG_HSTART,HSTART_VGA); |
smorioka | 0:d2c78848026d | 438 | WriteReg(REG_HSTOP,HSTOP_VGA); |
smorioka | 0:d2c78848026d | 439 | WriteReg(REG_HREF,HREF_VGA); |
smorioka | 0:d2c78848026d | 440 | WriteReg(REG_VSTART,VSTART_VGA); |
smorioka | 0:d2c78848026d | 441 | WriteReg(REG_VSTOP,VSTOP_VGA); |
smorioka | 0:d2c78848026d | 442 | WriteReg(REG_VREF,VREF_VGA); |
smorioka | 0:d2c78848026d | 443 | WriteReg(REG_COM3, COM3_VGA); |
smorioka | 0:d2c78848026d | 444 | WriteReg(REG_COM14, COM14_VGA); |
smorioka | 0:d2c78848026d | 445 | WriteReg(REG_SCALING_XSC, SCALING_XSC_VGA); |
smorioka | 0:d2c78848026d | 446 | WriteReg(REG_SCALING_YSC, SCALING_YSC_VGA); |
smorioka | 0:d2c78848026d | 447 | WriteReg(REG_SCALING_DCWCTR, SCALING_DCWCTR_VGA); |
smorioka | 0:d2c78848026d | 448 | WriteReg(REG_SCALING_PCLK_DIV, SCALING_PCLK_DIV_VGA); |
smorioka | 0:d2c78848026d | 449 | WriteReg(REG_SCALING_PCLK_DELAY, SCALING_PCLK_DELAY_VGA); |
smorioka | 0:d2c78848026d | 450 | |
smorioka | 0:d2c78848026d | 451 | WriteReg(REG_HSTART, 0x17); |
smorioka | 0:d2c78848026d | 452 | WriteReg(REG_HSTOP, 0x5b); |
smorioka | 0:d2c78848026d | 453 | WriteReg(REG_VSTART, 0x12); |
smorioka | 0:d2c78848026d | 454 | WriteReg(REG_VSTOP, 0x6c); |
smorioka | 0:d2c78848026d | 455 | } |
smorioka | 0:d2c78848026d | 456 | |
smorioka | 0:d2c78848026d | 457 | void InitVGA_3_4(void) { |
smorioka | 0:d2c78848026d | 458 | // VGA 3/4 -> 480x360 |
smorioka | 0:d2c78848026d | 459 | int reg_com7 = ReadReg(REG_COM7); |
smorioka | 0:d2c78848026d | 460 | |
smorioka | 0:d2c78848026d | 461 | WriteReg(REG_COM7,reg_com7|COM7_VGA); |
smorioka | 0:d2c78848026d | 462 | |
smorioka | 0:d2c78848026d | 463 | WriteReg(REG_HSTART,HSTART_VGA); |
smorioka | 0:d2c78848026d | 464 | WriteReg(REG_HSTOP,HSTOP_VGA); |
smorioka | 0:d2c78848026d | 465 | WriteReg(REG_HREF,HREF_VGA); |
smorioka | 0:d2c78848026d | 466 | WriteReg(REG_VSTART,VSTART_VGA); |
smorioka | 0:d2c78848026d | 467 | WriteReg(REG_VSTOP,VSTOP_VGA); |
smorioka | 0:d2c78848026d | 468 | WriteReg(REG_VREF,VREF_VGA); |
smorioka | 0:d2c78848026d | 469 | WriteReg(REG_COM3, COM3_VGA); |
smorioka | 0:d2c78848026d | 470 | WriteReg(REG_COM14, COM14_VGA); |
smorioka | 0:d2c78848026d | 471 | WriteReg(REG_SCALING_XSC, SCALING_XSC_VGA); |
smorioka | 0:d2c78848026d | 472 | WriteReg(REG_SCALING_YSC, SCALING_YSC_VGA); |
smorioka | 0:d2c78848026d | 473 | WriteReg(REG_SCALING_DCWCTR, SCALING_DCWCTR_VGA); |
smorioka | 0:d2c78848026d | 474 | WriteReg(REG_SCALING_PCLK_DIV, SCALING_PCLK_DIV_VGA); |
smorioka | 0:d2c78848026d | 475 | WriteReg(REG_SCALING_PCLK_DELAY, SCALING_PCLK_DELAY_VGA); |
smorioka | 0:d2c78848026d | 476 | |
smorioka | 0:d2c78848026d | 477 | WriteReg(REG_HSTART, 0x1b); |
smorioka | 0:d2c78848026d | 478 | WriteReg(REG_HSTOP, 0x57); |
smorioka | 0:d2c78848026d | 479 | WriteReg(REG_VSTART, 0x12); |
smorioka | 0:d2c78848026d | 480 | WriteReg(REG_VSTOP, 0x6c); |
smorioka | 0:d2c78848026d | 481 | } |
smorioka | 0:d2c78848026d | 482 | |
smorioka | 0:d2c78848026d | 483 | void InitQVGA(void) { |
smorioka | 0:d2c78848026d | 484 | // QQVGA |
smorioka | 0:d2c78848026d | 485 | int reg_com7 = ReadReg(REG_COM7); |
smorioka | 0:d2c78848026d | 486 | |
smorioka | 0:d2c78848026d | 487 | WriteReg(REG_COM7,reg_com7|COM7_QVGA); |
smorioka | 0:d2c78848026d | 488 | |
smorioka | 0:d2c78848026d | 489 | WriteReg(REG_HSTART,HSTART_QVGA); |
smorioka | 0:d2c78848026d | 490 | WriteReg(REG_HSTOP,HSTOP_QVGA); |
smorioka | 0:d2c78848026d | 491 | WriteReg(REG_HREF,HREF_QVGA); |
smorioka | 0:d2c78848026d | 492 | WriteReg(REG_VSTART,VSTART_QVGA); |
smorioka | 0:d2c78848026d | 493 | WriteReg(REG_VSTOP,VSTOP_QVGA); |
smorioka | 0:d2c78848026d | 494 | WriteReg(REG_VREF,VREF_QVGA); |
smorioka | 0:d2c78848026d | 495 | WriteReg(REG_COM3, COM3_QVGA); |
smorioka | 0:d2c78848026d | 496 | WriteReg(REG_COM14, COM14_QVGA); |
smorioka | 0:d2c78848026d | 497 | WriteReg(REG_SCALING_XSC, SCALING_XSC_QVGA); |
smorioka | 0:d2c78848026d | 498 | WriteReg(REG_SCALING_YSC, SCALING_YSC_QVGA); |
smorioka | 0:d2c78848026d | 499 | WriteReg(REG_SCALING_DCWCTR, SCALING_DCWCTR_QVGA); |
smorioka | 0:d2c78848026d | 500 | WriteReg(REG_SCALING_PCLK_DIV, SCALING_PCLK_DIV_QVGA); |
smorioka | 0:d2c78848026d | 501 | WriteReg(REG_SCALING_PCLK_DELAY, SCALING_PCLK_DELAY_QVGA); |
smorioka | 0:d2c78848026d | 502 | } |
smorioka | 0:d2c78848026d | 503 | |
smorioka | 0:d2c78848026d | 504 | void InitQQVGA(void) { |
smorioka | 0:d2c78848026d | 505 | // QQVGA |
smorioka | 0:d2c78848026d | 506 | int reg_com7 = ReadReg(REG_COM7); |
smorioka | 0:d2c78848026d | 507 | |
smorioka | 0:d2c78848026d | 508 | WriteReg(REG_COM7,reg_com7|COM7_QQVGA); |
smorioka | 0:d2c78848026d | 509 | |
smorioka | 0:d2c78848026d | 510 | WriteReg(REG_HSTART,HSTART_QQVGA); |
smorioka | 0:d2c78848026d | 511 | WriteReg(REG_HSTOP,HSTOP_QQVGA); |
smorioka | 0:d2c78848026d | 512 | WriteReg(REG_HREF,HREF_QQVGA); |
smorioka | 0:d2c78848026d | 513 | WriteReg(REG_VSTART,VSTART_QQVGA); |
smorioka | 0:d2c78848026d | 514 | WriteReg(REG_VSTOP,VSTOP_QQVGA); |
smorioka | 0:d2c78848026d | 515 | WriteReg(REG_VREF,VREF_QQVGA); |
smorioka | 0:d2c78848026d | 516 | WriteReg(REG_COM3, COM3_QQVGA); |
smorioka | 0:d2c78848026d | 517 | WriteReg(REG_COM14, COM14_QQVGA); |
smorioka | 0:d2c78848026d | 518 | WriteReg(REG_SCALING_XSC, SCALING_XSC_QQVGA); |
smorioka | 0:d2c78848026d | 519 | WriteReg(REG_SCALING_YSC, SCALING_YSC_QQVGA); |
smorioka | 0:d2c78848026d | 520 | WriteReg(REG_SCALING_DCWCTR, SCALING_DCWCTR_QQVGA); |
smorioka | 0:d2c78848026d | 521 | WriteReg(REG_SCALING_PCLK_DIV, SCALING_PCLK_DIV_QQVGA); |
smorioka | 0:d2c78848026d | 522 | WriteReg(REG_SCALING_PCLK_DELAY, SCALING_PCLK_DELAY_QQVGA); |
smorioka | 0:d2c78848026d | 523 | } |
smorioka | 0:d2c78848026d | 524 | |
smorioka | 0:d2c78848026d | 525 | // vsync handler |
smorioka | 0:d2c78848026d | 526 | void VsyncHandler(void) |
smorioka | 0:d2c78848026d | 527 | { |
smorioka | 0:d2c78848026d | 528 | // Capture Enable |
smorioka | 0:d2c78848026d | 529 | if (CaptureReq) { |
smorioka | 0:d2c78848026d | 530 | wen = 1; |
smorioka | 0:d2c78848026d | 531 | Done = false; |
smorioka | 0:d2c78848026d | 532 | CaptureReq = false; |
smorioka | 0:d2c78848026d | 533 | } else { |
smorioka | 0:d2c78848026d | 534 | wen = 0; |
smorioka | 0:d2c78848026d | 535 | if (Busy) { |
smorioka | 0:d2c78848026d | 536 | Busy = false; |
smorioka | 0:d2c78848026d | 537 | Done = true; |
smorioka | 0:d2c78848026d | 538 | } |
smorioka | 0:d2c78848026d | 539 | } |
smorioka | 0:d2c78848026d | 540 | |
smorioka | 0:d2c78848026d | 541 | // Hline Counter |
smorioka | 0:d2c78848026d | 542 | LastLines = LineCounter; |
smorioka | 0:d2c78848026d | 543 | LineCounter = 0; |
smorioka | 0:d2c78848026d | 544 | } |
smorioka | 0:d2c78848026d | 545 | |
smorioka | 0:d2c78848026d | 546 | // href handler |
smorioka | 0:d2c78848026d | 547 | void HrefHandler(void) |
smorioka | 0:d2c78848026d | 548 | { |
smorioka | 0:d2c78848026d | 549 | LineCounter++; |
smorioka | 0:d2c78848026d | 550 | } |
smorioka | 0:d2c78848026d | 551 | |
smorioka | 0:d2c78848026d | 552 | // Data Read |
smorioka | 0:d2c78848026d | 553 | int ReadOneByte(void) |
smorioka | 0:d2c78848026d | 554 | { |
smorioka | 0:d2c78848026d | 555 | int result; |
smorioka | 0:d2c78848026d | 556 | rclk = 1; |
smorioka | 0:d2c78848026d | 557 | // wait_us(1); |
smorioka | 0:d2c78848026d | 558 | result = data; |
smorioka | 0:d2c78848026d | 559 | rclk = 0; |
smorioka | 0:d2c78848026d | 560 | return result; |
smorioka | 0:d2c78848026d | 561 | } |
smorioka | 0:d2c78848026d | 562 | |
smorioka | 0:d2c78848026d | 563 | // Data Start |
smorioka | 0:d2c78848026d | 564 | void ReadStart(void) |
smorioka | 0:d2c78848026d | 565 | { |
smorioka | 0:d2c78848026d | 566 | rrst = 0; |
smorioka | 0:d2c78848026d | 567 | oe = 0; |
smorioka | 0:d2c78848026d | 568 | wait_us(1); |
smorioka | 0:d2c78848026d | 569 | rclk = 0; |
smorioka | 0:d2c78848026d | 570 | wait_us(1); |
smorioka | 0:d2c78848026d | 571 | rclk = 1; |
smorioka | 0:d2c78848026d | 572 | wait_us(1); |
smorioka | 0:d2c78848026d | 573 | rrst = 1; |
smorioka | 0:d2c78848026d | 574 | } |
smorioka | 0:d2c78848026d | 575 | |
smorioka | 0:d2c78848026d | 576 | // Data Stop |
smorioka | 0:d2c78848026d | 577 | void ReadStop(void) |
smorioka | 0:d2c78848026d | 578 | { |
smorioka | 0:d2c78848026d | 579 | oe = 1; |
smorioka | 0:d2c78848026d | 580 | ReadOneByte(); |
smorioka | 0:d2c78848026d | 581 | rclk = 1; |
smorioka | 0:d2c78848026d | 582 | } |
smorioka | 0:d2c78848026d | 583 | }; |