Sumio Morioka / Mbed 2 deprecated if201410_section4

First release.

Dependencies:   TextLCD mbed

Sample code of section 4 in Oct 2014 issue of the Interface Magazine, published by CQ publishing in Japan. CQ出版社インターフェース誌 2014年10月号4章に掲載のサンプルコードです．

LPC1768にトラ技OV7670モジュールを接続し，撮影した画像をBMPファイルとしてフラッシュメモリに保存します（PCから見ることができます）．このコードのうちカメラ制御部には，Sadaei Osakabe氏のコードを流用させていただいています．

ov7670.h@0:33db72b46e9b, 2014-08-26 (annotated)

Committer:
smorioka
Date:
Tue Aug 26 16:47:47 2014 +0000
Revision:
0:33db72b46e9b
Sample code of section 4 in Oct 2014 issue of the Interface Magazine, published by CQ publishing in Japan.

Who changed what in which revision?

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