Igor Levkov / levkov_ov7670

test

Dependencies:   zbar_010

Fork of ov7670 by Edoardo De Marchi

ov7670.cpp@5:a940d64a408b, 2017-09-25 (annotated)

Committer:
levkovigor
Date:
Mon Sep 25 12:38:33 2017 +0000
Revision:
5:a940d64a408b
Parent:
3:b40a945dd672 
test

Who changed what in which revision?

UserRevisionLine numberNew contents of line
edodm85 0:810d59d0b843 1 #include "ov7670.h"
edodm85 0:810d59d0b843 2
edodm85 0:810d59d0b843 3
levkovigor 5:a940d64a408b 4 //OV7670::OV7670(PinName sda, PinName scl, PinName vs, PinName hr, PinName we, PortName port, int mask, PinName rt, PinName o, PinName rc) : _i2c(sda,scl),vsync(vs),href(hr),wen(we),data(port,mask),rrst(rt),oe(o),rclk(rc)
levkovigor 5:a940d64a408b 5 OV7670::OV7670(PinName sda, PinName scl, PinName vs, PinName hr, PinName we, PinName d7, // D7
levkovigor 5:a940d64a408b 6 PinName d6, // D6
levkovigor 5:a940d64a408b 7 PinName d5, // D5
levkovigor 5:a940d64a408b 8 PinName d4, // D4
levkovigor 5:a940d64a408b 9 PinName d3, // D3
levkovigor 5:a940d64a408b 10 PinName d2, // D2
levkovigor 5:a940d64a408b 11 PinName d1, // D1
levkovigor 5:a940d64a408b 12 PinName d0, // D0
levkovigor 5:a940d64a408b 13 PinName rt, PinName o, PinName rc) : _i2c(sda,scl),vsync(vs),href(hr),wen(we),data(d0,d1,d2,d3,d4,d5,d6,d7),rrst(rt),oe(o),rclk(rc)
edodm85 0:810d59d0b843 14 {
edodm85 0:810d59d0b843 15 _i2c.stop();
edodm85 0:810d59d0b843 16 _i2c.frequency(OV7670_I2CFREQ);
edodm85 0:810d59d0b843 17 vsync.fall(this,&OV7670::VsyncHandler); // interrupt fall edge
edodm85 0:810d59d0b843 18 CaptureReq = false;
edodm85 0:810d59d0b843 19 Busy = false;
edodm85 0:810d59d0b843 20 Done = false;
edodm85 0:810d59d0b843 21 LineCounter = 0;
edodm85 0:810d59d0b843 22 rrst = 1;
edodm85 0:810d59d0b843 23 oe = 1;
edodm85 0:810d59d0b843 24 rclk = 1;
edodm85 0:810d59d0b843 25 wen = 0;
edodm85 0:810d59d0b843 26 }
edodm85 0:810d59d0b843 27
edodm85 3:b40a945dd672 28
edodm85 0:810d59d0b843 29 OV7670::~OV7670()
edodm85 0:810d59d0b843 30 {
edodm85 3:b40a945dd672 31 }
edodm85 0:810d59d0b843 32
edodm85 0:810d59d0b843 33
edodm85 0:810d59d0b843 34 // capture request
edodm85 0:810d59d0b843 35 void OV7670::CaptureNext(void)
edodm85 0:810d59d0b843 36 {
edodm85 3:b40a945dd672 37 CaptureReq = true;
edodm85 3:b40a945dd672 38 Busy = true;
edodm85 0:810d59d0b843 39 }
edodm85 0:810d59d0b843 40
edodm85 3:b40a945dd672 41
edodm85 0:810d59d0b843 42 // capture done? (with clear)
edodm85 0:810d59d0b843 43 bool OV7670::CaptureDone(void)
edodm85 0:810d59d0b843 44 {
edodm85 3:b40a945dd672 45 bool result;
edodm85 3:b40a945dd672 46 if (Busy)
edodm85 3:b40a945dd672 47 {
edodm85 3:b40a945dd672 48 result = false;
edodm85 3:b40a945dd672 49 }else
edodm85 3:b40a945dd672 50 {
edodm85 3:b40a945dd672 51 result = Done;
edodm85 3:b40a945dd672 52 Done = false;
edodm85 0:810d59d0b843 53 }
edodm85 3:b40a945dd672 54 return result;
edodm85 0:810d59d0b843 55 }
edodm85 0:810d59d0b843 56
edodm85 3:b40a945dd672 57
edodm85 3:b40a945dd672 58 // vsync handler
edodm85 3:b40a945dd672 59 void OV7670::VsyncHandler(void)
edodm85 3:b40a945dd672 60 {
edodm85 3:b40a945dd672 61 // Capture Enable
edodm85 3:b40a945dd672 62 if (CaptureReq)
edodm85 3:b40a945dd672 63 {
edodm85 3:b40a945dd672 64 wen = 1;
edodm85 3:b40a945dd672 65 Done = false;
edodm85 3:b40a945dd672 66 CaptureReq = false;
edodm85 3:b40a945dd672 67 }else
edodm85 3:b40a945dd672 68 {
edodm85 3:b40a945dd672 69 wen = 0;
edodm85 3:b40a945dd672 70 if (Busy)
edodm85 3:b40a945dd672 71 {
edodm85 3:b40a945dd672 72 Busy = false;
edodm85 3:b40a945dd672 73 Done = true;
edodm85 3:b40a945dd672 74 }
edodm85 3:b40a945dd672 75 }
edodm85 0:810d59d0b843 76 }
edodm85 0:810d59d0b843 77
edodm85 3:b40a945dd672 78
edodm85 3:b40a945dd672 79 // Data Read
edodm85 3:b40a945dd672 80 int OV7670::ReadOnebyte(void)
edodm85 0:810d59d0b843 81 {
levkovigor 5:a940d64a408b 82 /*int B1;
edodm85 3:b40a945dd672 83 rclk = 1;
edodm85 3:b40a945dd672 84 B1 = (((data&0x07800000)>>19)|((data&0x078000)>>15));
edodm85 3:b40a945dd672 85 rclk = 0;
levkovigor 5:a940d64a408b 86 return B1; */
levkovigor 5:a940d64a408b 87
levkovigor 5:a940d64a408b 88 int result ;
levkovigor 5:a940d64a408b 89 rclk = 1 ;
levkovigor 5:a940d64a408b 90 // wait_us(1) ;
levkovigor 5:a940d64a408b 91 result = data ;
levkovigor 5:a940d64a408b 92 rclk = 0 ;
levkovigor 5:a940d64a408b 93 return result ;
levkovigor 5:a940d64a408b 94
levkovigor 5:a940d64a408b 95
levkovigor 5:a940d64a408b 96 /*int result;
levkovigor 5:a940d64a408b 97 rclk = 1;
levkovigor 5:a940d64a408b 98 result = data;
levkovigor 5:a940d64a408b 99
levkovigor 5:a940d64a408b 100 // Shift the bits around to form the byte
levkovigor 5:a940d64a408b 101 int top = result >> 19; // Isolate the top nibble
levkovigor 5:a940d64a408b 102 int middle = result >> 2; // Isolate bits 2 & 3
levkovigor 5:a940d64a408b 103 result = result & 0x00000003; // Isolate bits 0 & 1
levkovigor 5:a940d64a408b 104
levkovigor 5:a940d64a408b 105 result += middle;
levkovigor 5:a940d64a408b 106 result += top;
levkovigor 5:a940d64a408b 107
levkovigor 5:a940d64a408b 108 rclk = 0;
levkovigor 5:a940d64a408b 109 return result;*/
levkovigor 5:a940d64a408b 110
levkovigor 5:a940d64a408b 111
edodm85 0:810d59d0b843 112 }
edodm85 0:810d59d0b843 113
edodm85 3:b40a945dd672 114
levkovigor 5:a940d64a408b 115
edodm85 3:b40a945dd672 116 // Data Start read from FIFO
edodm85 3:b40a945dd672 117 void OV7670::ReadStart(void)
edodm85 3:b40a945dd672 118 {
edodm85 3:b40a945dd672 119 rrst = 0;
edodm85 3:b40a945dd672 120 oe = 0;
edodm85 3:b40a945dd672 121 wait_us(1);
edodm85 3:b40a945dd672 122 rclk = 0;
edodm85 3:b40a945dd672 123 wait_us(1);
edodm85 3:b40a945dd672 124 rclk = 1;
edodm85 3:b40a945dd672 125 wait_us(1);
edodm85 3:b40a945dd672 126 rrst = 1;
edodm85 0:810d59d0b843 127 }
edodm85 0:810d59d0b843 128
edodm85 3:b40a945dd672 129
edodm85 3:b40a945dd672 130 // Data Stop read from FIFO
edodm85 3:b40a945dd672 131 void OV7670::ReadStop(void)
edodm85 3:b40a945dd672 132 {
edodm85 3:b40a945dd672 133 oe = 1;
edodm85 3:b40a945dd672 134 ReadOnebyte();
edodm85 3:b40a945dd672 135 rclk = 1;
edodm85 3:b40a945dd672 136 }
edodm85 3:b40a945dd672 137
edodm85 3:b40a945dd672 138
edodm85 3:b40a945dd672 139 void OV7670::Reset(void)
edodm85 3:b40a945dd672 140 {
edodm85 3:b40a945dd672 141 WriteReg(0x12, 0x80); // RESET CAMERA
edodm85 3:b40a945dd672 142 wait_ms(200);
edodm85 3:b40a945dd672 143 }
edodm85 3:b40a945dd672 144
edodm85 3:b40a945dd672 145
edodm85 1:d82dbad9c06b 146 int OV7670::Init(char c, int n)
edodm85 0:810d59d0b843 147 {
edodm85 0:810d59d0b843 148
edodm85 2:354a00023f79 149 if (ReadReg(REG_PID) != 0x76) // check id camera
edodm85 0:810d59d0b843 150 {
edodm85 0:810d59d0b843 151 return 0;
edodm85 0:810d59d0b843 152 }
edodm85 0:810d59d0b843 153
edodm85 2:354a00023f79 154 Reset(); // Resets all registers to default values
edodm85 2:354a00023f79 155 Reset(); // Resets all registers to default values
edodm85 1:d82dbad9c06b 156
edodm85 2:354a00023f79 157 WriteReg(REG_RGB444, 0x00); // Disable RGB444
edodm85 3:b40a945dd672 158 WriteReg(REG_COM10, 0x02); // 0x02 VSYNC negative (http://thinksmallthings.wordpress.com/2012/03/10/cf7670c-vs-cf7670c-v2/)
edodm85 2:354a00023f79 159 WriteReg(REG_MVFP, 0x27); // mirror image
edodm85 1:d82dbad9c06b 160
edodm85 2:354a00023f79 161 WriteReg(REG_CLKRC, 0x80); // prescaler x1
edodm85 2:354a00023f79 162 WriteReg(DBLV, 0x0a); // bypass PLL
edodm85 1:d82dbad9c06b 163
edodm85 2:354a00023f79 164 WriteReg(REG_COM11, 0x0A) ;
edodm85 2:354a00023f79 165 WriteReg(REG_TSLB, 0x04); // 0D = UYVY 04 = YUYV
edodm85 2:354a00023f79 166 WriteReg(REG_COM13, 0x88); // connect to REG_TSLB
edodm85 0:810d59d0b843 167
edodm85 1:d82dbad9c06b 168
edodm85 1:d82dbad9c06b 169 if(c == 'b' || c == 'y') // YUV
edodm85 1:d82dbad9c06b 170 {
edodm85 1:d82dbad9c06b 171 WriteReg(REG_COM7, 0x00); // YUV
edodm85 1:d82dbad9c06b 172 WriteReg(REG_COM17, 0x00); // color bar disable
edodm85 1:d82dbad9c06b 173 WriteReg(REG_COM3, 0x04);
edodm85 1:d82dbad9c06b 174 WriteReg(REG_COM15, 0xC0); // Set normal rgb with Full range
edodm85 1:d82dbad9c06b 175
edodm85 1:d82dbad9c06b 176 }else
edodm85 1:d82dbad9c06b 177 if(c == 'r') // RGB565
edodm85 1:d82dbad9c06b 178 {
edodm85 1:d82dbad9c06b 179 WriteReg(REG_COM7, 0x04); // RGB + color bar disable
edodm85 1:d82dbad9c06b 180 WriteReg(REG_RGB444, 0x00); // Disable RGB444
edodm85 1:d82dbad9c06b 181 WriteReg(REG_COM15, 0x10); // Set rgb565 with Full range 0xD0
edodm85 1:d82dbad9c06b 182 WriteReg(REG_COM3, 0x04);
edodm85 2:354a00023f79 183 WriteReg(REG_CLKRC, 0x80); // prescaler x1
edodm85 1:d82dbad9c06b 184 }
edodm85 1:d82dbad9c06b 185
edodm85 1:d82dbad9c06b 186 WriteReg(0x70, 0x3A); // Scaling Xsc
edodm85 1:d82dbad9c06b 187 WriteReg(0x71, 0x35); // Scaling Ysc
edodm85 1:d82dbad9c06b 188 WriteReg(0xA2, 0x02); // pixel clock delay
edodm85 1:d82dbad9c06b 189
edodm85 1:d82dbad9c06b 190 if(n == 19200) // 160*120
edodm85 1:d82dbad9c06b 191 {
edodm85 1:d82dbad9c06b 192 WriteReg(REG_COM14, 0x1a); // divide by 4
edodm85 1:d82dbad9c06b 193 WriteReg(0x72, 0x22); // downsample by 4
edodm85 1:d82dbad9c06b 194 WriteReg(0x73, 0xf2); // divide by 4
edodm85 2:354a00023f79 195 WriteReg(REG_HREF, 0xa4);
edodm85 2:354a00023f79 196 WriteReg(REG_HSTART, 0x16);
edodm85 2:354a00023f79 197 WriteReg(REG_HSTOP, 0x04);
edodm85 2:354a00023f79 198 WriteReg(REG_VREF, 0x0a);
edodm85 2:354a00023f79 199 WriteReg(REG_VSTART, 0x02);
edodm85 2:354a00023f79 200 WriteReg(REG_VSTOP, 0x7a);
edodm85 2:354a00023f79 201
edodm85 2:354a00023f79 202 WriteReg(0x7a, 0x20);
edodm85 2:354a00023f79 203 WriteReg(0x7b, 0x1c);
edodm85 2:354a00023f79 204 WriteReg(0x7c, 0x28);
edodm85 2:354a00023f79 205 WriteReg(0x7d, 0x3c);
edodm85 2:354a00023f79 206 WriteReg(0x7e, 0x5a);
edodm85 2:354a00023f79 207 WriteReg(0x7f, 0x68);
edodm85 2:354a00023f79 208 WriteReg(0x80, 0x76);
edodm85 2:354a00023f79 209 WriteReg(0x81, 0x80);
edodm85 2:354a00023f79 210 WriteReg(0x82, 0x88);
edodm85 2:354a00023f79 211 WriteReg(0x83, 0x8f);
edodm85 2:354a00023f79 212 WriteReg(0x84, 0x96);
edodm85 2:354a00023f79 213 WriteReg(0x85, 0xa3);
edodm85 2:354a00023f79 214 WriteReg(0x86, 0xaf);
edodm85 2:354a00023f79 215 WriteReg(0x87, 0xc4);
edodm85 2:354a00023f79 216 WriteReg(0x88, 0xd7);
edodm85 2:354a00023f79 217 WriteReg(0x89, 0xe8);
edodm85 2:354a00023f79 218
edodm85 2:354a00023f79 219 WriteReg(0x13, 0xe0);
edodm85 2:354a00023f79 220 WriteReg(0x00, 0x00);
edodm85 2:354a00023f79 221 WriteReg(0x10, 0x00);
edodm85 2:354a00023f79 222 WriteReg(0x0d, 0x40);
edodm85 2:354a00023f79 223 WriteReg(0x14, 0x18);
edodm85 2:354a00023f79 224 WriteReg(0xa5, 0x05);
edodm85 2:354a00023f79 225 WriteReg(0xab, 0x07);
edodm85 2:354a00023f79 226 WriteReg(0x24, 0x95);
edodm85 2:354a00023f79 227 WriteReg(0x25, 0x33);
edodm85 2:354a00023f79 228 WriteReg(0x26, 0xe3);
edodm85 2:354a00023f79 229 WriteReg(0x9f, 0x78);
edodm85 2:354a00023f79 230 WriteReg(0xa0, 0x68);
edodm85 2:354a00023f79 231 WriteReg(0xa1, 0x03);
edodm85 2:354a00023f79 232 WriteReg(0xa6, 0xd8);
edodm85 2:354a00023f79 233 WriteReg(0xa7, 0xd8);
edodm85 2:354a00023f79 234 WriteReg(0xa8, 0xf0);
edodm85 2:354a00023f79 235 WriteReg(0xa9, 0x90);
edodm85 2:354a00023f79 236 WriteReg(0xaa, 0x94);
edodm85 2:354a00023f79 237 WriteReg(0x13, 0xe5);
edodm85 2:354a00023f79 238
edodm85 2:354a00023f79 239 WriteReg(0x0e, 0x61);
edodm85 2:354a00023f79 240 WriteReg(0x0f, 0x4b);
edodm85 2:354a00023f79 241 WriteReg(0x16, 0x02);
edodm85 2:354a00023f79 242
edodm85 2:354a00023f79 243 WriteReg(0x21, 0x02);
edodm85 2:354a00023f79 244 WriteReg(0x22, 0x91);
edodm85 2:354a00023f79 245 WriteReg(0x29, 0x07);
edodm85 2:354a00023f79 246 WriteReg(0x33, 0x0b);
edodm85 2:354a00023f79 247 WriteReg(0x35, 0x0b);
edodm85 2:354a00023f79 248 WriteReg(0x37, 0x1d);
edodm85 2:354a00023f79 249 WriteReg(0x38, 0x71);
edodm85 2:354a00023f79 250 WriteReg(0x39, 0x2a);
edodm85 2:354a00023f79 251 WriteReg(0x3c, 0x78);
edodm85 2:354a00023f79 252 WriteReg(0x4d, 0x40);
edodm85 2:354a00023f79 253 WriteReg(0x4e, 0x20);
edodm85 2:354a00023f79 254 WriteReg(0x69, 0x00);
edodm85 2:354a00023f79 255
edodm85 2:354a00023f79 256 WriteReg(0x74, 0x10);
edodm85 2:354a00023f79 257 WriteReg(0x8d, 0x4f);
edodm85 2:354a00023f79 258 WriteReg(0x8e, 0x00);
edodm85 2:354a00023f79 259 WriteReg(0x8f, 0x00);
edodm85 2:354a00023f79 260 WriteReg(0x90, 0x00);
edodm85 2:354a00023f79 261 WriteReg(0x91, 0x00);
edodm85 2:354a00023f79 262 WriteReg(0x92, 0x00);
edodm85 2:354a00023f79 263
edodm85 2:354a00023f79 264 WriteReg(0x96, 0x00);
edodm85 2:354a00023f79 265 WriteReg(0x9a, 0x80);
edodm85 2:354a00023f79 266 WriteReg(0xb0, 0x84);
edodm85 2:354a00023f79 267 WriteReg(0xb1, 0x0c);
edodm85 2:354a00023f79 268 WriteReg(0xb2, 0x0e);
edodm85 2:354a00023f79 269 WriteReg(0xb3, 0x82);
edodm85 2:354a00023f79 270 WriteReg(0xb8, 0x0a);
edodm85 2:354a00023f79 271
edodm85 2:354a00023f79 272 WriteReg(0x43, 0x0a);
edodm85 2:354a00023f79 273 WriteReg(0x44, 0xf0);
edodm85 2:354a00023f79 274 WriteReg(0x45, 0x34);
edodm85 2:354a00023f79 275 WriteReg(0x46, 0x58);
edodm85 2:354a00023f79 276 WriteReg(0x47, 0x28);
edodm85 2:354a00023f79 277 WriteReg(0x48, 0x3a);
edodm85 2:354a00023f79 278 WriteReg(0x59, 0x88);
edodm85 2:354a00023f79 279 WriteReg(0x5a, 0x88);
edodm85 2:354a00023f79 280 WriteReg(0x5b, 0x44);
edodm85 2:354a00023f79 281 WriteReg(0x5c, 0x67);
edodm85 2:354a00023f79 282 WriteReg(0x5d, 0x49);
edodm85 2:354a00023f79 283 WriteReg(0x5e, 0x0e);
edodm85 2:354a00023f79 284 WriteReg(0x64, 0x04);
edodm85 2:354a00023f79 285 WriteReg(0x65, 0x20);
edodm85 2:354a00023f79 286 WriteReg(0x66, 0x05);
edodm85 2:354a00023f79 287 WriteReg(0x94, 0x04);
edodm85 2:354a00023f79 288 WriteReg(0x95, 0x08);
edodm85 2:354a00023f79 289
edodm85 2:354a00023f79 290 WriteReg(0x6c, 0x0a);
edodm85 2:354a00023f79 291 WriteReg(0x6d, 0x55);
edodm85 2:354a00023f79 292 WriteReg(0x6e, 0x11);
edodm85 2:354a00023f79 293 WriteReg(0x6f, 0x9f);
edodm85 2:354a00023f79 294 WriteReg(0x6a, 0x40);
edodm85 2:354a00023f79 295 WriteReg(0x01, 0x40);
edodm85 2:354a00023f79 296 WriteReg(0x02, 0x40);
edodm85 2:354a00023f79 297 WriteReg(0x13, 0xe7);
edodm85 3:b40a945dd672 298 //WriteReg(0x15, 0x02);
edodm85 2:354a00023f79 299
edodm85 2:354a00023f79 300 WriteReg(0x4f, 0x80);
edodm85 2:354a00023f79 301 WriteReg(0x50, 0x80);
edodm85 2:354a00023f79 302 WriteReg(0x51, 0x00);
edodm85 2:354a00023f79 303 WriteReg(0x52, 0x22);
edodm85 2:354a00023f79 304 WriteReg(0x53, 0x5e);
edodm85 2:354a00023f79 305 WriteReg(0x54, 0x80);
edodm85 2:354a00023f79 306 WriteReg(0x58, 0x9e);
edodm85 2:354a00023f79 307
edodm85 2:354a00023f79 308 WriteReg(0x41, 0x08);
edodm85 2:354a00023f79 309 WriteReg(0x3f, 0x00);
edodm85 2:354a00023f79 310 WriteReg(0x75, 0x05);
edodm85 2:354a00023f79 311 WriteReg(0x76, 0xe1);
edodm85 2:354a00023f79 312 WriteReg(0x4c, 0x00);
edodm85 2:354a00023f79 313 WriteReg(0x77, 0x01);
edodm85 2:354a00023f79 314 WriteReg(0x3d, 0xc1);
edodm85 2:354a00023f79 315 WriteReg(0x4b, 0x09);
edodm85 2:354a00023f79 316 WriteReg(0xc9, 0x60);
edodm85 2:354a00023f79 317 WriteReg(0x41, 0x38);
edodm85 2:354a00023f79 318 WriteReg(0x56, 0x40);
edodm85 2:354a00023f79 319
edodm85 2:354a00023f79 320 WriteReg(0x34, 0x11);
edodm85 2:354a00023f79 321 WriteReg(0x3b, 0x02);
edodm85 2:354a00023f79 322 WriteReg(0xa4, 0x88);
edodm85 2:354a00023f79 323 WriteReg(0x96, 0x00);
edodm85 2:354a00023f79 324 WriteReg(0x97, 0x30);
edodm85 2:354a00023f79 325 WriteReg(0x98, 0x20);
edodm85 2:354a00023f79 326 WriteReg(0x99, 0x30);
edodm85 2:354a00023f79 327 WriteReg(0x9a, 0x84);
edodm85 2:354a00023f79 328 WriteReg(0x9b, 0x29);
edodm85 2:354a00023f79 329 WriteReg(0x9c, 0x03);
edodm85 2:354a00023f79 330 WriteReg(0x9d, 0x4c);
edodm85 2:354a00023f79 331 WriteReg(0x9e, 0x3f);
edodm85 2:354a00023f79 332 WriteReg(0x78, 0x04);
edodm85 2:354a00023f79 333
edodm85 2:354a00023f79 334 WriteReg(0x79, 0x01);
edodm85 2:354a00023f79 335 WriteReg(0xc8, 0xf0);
edodm85 2:354a00023f79 336 WriteReg(0x79, 0x0f);
edodm85 2:354a00023f79 337 WriteReg(0xc8, 0x00);
edodm85 2:354a00023f79 338 WriteReg(0x79, 0x10);
edodm85 2:354a00023f79 339 WriteReg(0xc8, 0x7e);
edodm85 2:354a00023f79 340 WriteReg(0x79, 0x0a);
edodm85 2:354a00023f79 341 WriteReg(0xc8, 0x80);
edodm85 2:354a00023f79 342 WriteReg(0x79, 0x0b);
edodm85 2:354a00023f79 343 WriteReg(0xc8, 0x01);
edodm85 2:354a00023f79 344 WriteReg(0x79, 0x0c);
edodm85 2:354a00023f79 345 WriteReg(0xc8, 0x0f);
edodm85 2:354a00023f79 346 WriteReg(0x79, 0x0d);
edodm85 2:354a00023f79 347 WriteReg(0xc8, 0x20);
edodm85 2:354a00023f79 348 WriteReg(0x79, 0x09);
edodm85 2:354a00023f79 349 WriteReg(0xc8, 0x80);
edodm85 2:354a00023f79 350 WriteReg(0x79, 0x02);
edodm85 2:354a00023f79 351 WriteReg(0xc8, 0xc0);
edodm85 2:354a00023f79 352 WriteReg(0x79, 0x03);
edodm85 2:354a00023f79 353 WriteReg(0xc8, 0x40);
edodm85 2:354a00023f79 354 WriteReg(0x79, 0x05);
edodm85 2:354a00023f79 355 WriteReg(0xc8, 0x30);
edodm85 2:354a00023f79 356 WriteReg(0x79, 0x26);
edodm85 2:354a00023f79 357 WriteReg(0x09, 0x03);
edodm85 2:354a00023f79 358 WriteReg(0x3b, 0x42);
edodm85 2:354a00023f79 359
edodm85 2:354a00023f79 360 WriteReg(0xff, 0xff); /* END MARKER */
edodm85 2:354a00023f79 361
edodm85 1:d82dbad9c06b 362 }
edodm85 1:d82dbad9c06b 363 if(n == 76800) // 320*240
edodm85 1:d82dbad9c06b 364 {
edodm85 1:d82dbad9c06b 365 WriteReg(REG_COM14, 0x19);
edodm85 1:d82dbad9c06b 366 WriteReg(0x72, 0x11);
edodm85 1:d82dbad9c06b 367 WriteReg(0x73, 0xf1);
edodm85 2:354a00023f79 368 WriteReg(REG_HREF, 0x24);
edodm85 2:354a00023f79 369 WriteReg(REG_HSTART, 0x16);
edodm85 2:354a00023f79 370 WriteReg(REG_HSTOP, 0x04);
edodm85 2:354a00023f79 371 WriteReg(REG_VREF, 0x0a);
edodm85 1:d82dbad9c06b 372 WriteReg(REG_VSTART,0x02);
edodm85 2:354a00023f79 373 WriteReg(REG_VSTOP, 0x7a);
edodm85 2:354a00023f79 374
edodm85 2:354a00023f79 375 WriteReg(0x7a, 0x20);
edodm85 2:354a00023f79 376 WriteReg(0x7b, 0x1c);
edodm85 2:354a00023f79 377 WriteReg(0x7c, 0x28);
edodm85 2:354a00023f79 378 WriteReg(0x7d, 0x3c);
edodm85 2:354a00023f79 379 WriteReg(0x7e, 0x55);
edodm85 2:354a00023f79 380 WriteReg(0x7f, 0x68);
edodm85 2:354a00023f79 381 WriteReg(0x80, 0x76);
edodm85 2:354a00023f79 382 WriteReg(0x81, 0x80);
edodm85 2:354a00023f79 383 WriteReg(0x82, 0x88);
edodm85 2:354a00023f79 384 WriteReg(0x83, 0x8f);
edodm85 2:354a00023f79 385 WriteReg(0x84, 0x96);
edodm85 2:354a00023f79 386 WriteReg(0x85, 0xa3);
edodm85 2:354a00023f79 387 WriteReg(0x86, 0xaf);
edodm85 2:354a00023f79 388 WriteReg(0x87, 0xc4);
edodm85 2:354a00023f79 389 WriteReg(0x88, 0xd7);
edodm85 2:354a00023f79 390 WriteReg(0x89, 0xe8);
edodm85 2:354a00023f79 391
edodm85 2:354a00023f79 392 WriteReg(0x13, 0xe0);
edodm85 2:354a00023f79 393 WriteReg(0x00, 0x00);
edodm85 2:354a00023f79 394 WriteReg(0x10, 0x00);
edodm85 2:354a00023f79 395 WriteReg(0x0d, 0x00);
edodm85 2:354a00023f79 396 WriteReg(0x14, 0x28);
edodm85 2:354a00023f79 397 WriteReg(0xa5, 0x05);
edodm85 2:354a00023f79 398 WriteReg(0xab, 0x07);
edodm85 2:354a00023f79 399 WriteReg(0x24, 0x75);
edodm85 2:354a00023f79 400 WriteReg(0x25, 0x63);
edodm85 2:354a00023f79 401 WriteReg(0x26, 0xA5);
edodm85 2:354a00023f79 402 WriteReg(0x9f, 0x78);
edodm85 2:354a00023f79 403 WriteReg(0xa0, 0x68);
edodm85 2:354a00023f79 404 WriteReg(0xa1, 0x03);
edodm85 2:354a00023f79 405 WriteReg(0xa6, 0xdf);
edodm85 2:354a00023f79 406 WriteReg(0xa7, 0xdf);
edodm85 2:354a00023f79 407 WriteReg(0xa8, 0xf0);
edodm85 2:354a00023f79 408 WriteReg(0xa9, 0x90);
edodm85 2:354a00023f79 409 WriteReg(0xaa, 0x94);
edodm85 2:354a00023f79 410 WriteReg(0x13, 0xe5);
edodm85 2:354a00023f79 411
edodm85 2:354a00023f79 412 WriteReg(0x0e, 0x61);
edodm85 2:354a00023f79 413 WriteReg(0x0f, 0x4b);
edodm85 2:354a00023f79 414 WriteReg(0x16, 0x02);
edodm85 2:354a00023f79 415 WriteReg(0x21, 0x02);
edodm85 2:354a00023f79 416 WriteReg(0x22, 0x91);
edodm85 2:354a00023f79 417 WriteReg(0x29, 0x07);
edodm85 2:354a00023f79 418 WriteReg(0x33, 0x0b);
edodm85 2:354a00023f79 419 WriteReg(0x35, 0x0b);
edodm85 2:354a00023f79 420 WriteReg(0x37, 0x1d);
edodm85 2:354a00023f79 421 WriteReg(0x38, 0x71);
edodm85 2:354a00023f79 422 WriteReg(0x39, 0x2a);
edodm85 2:354a00023f79 423 WriteReg(0x3c, 0x78);
edodm85 2:354a00023f79 424 WriteReg(0x4d, 0x40);
edodm85 2:354a00023f79 425 WriteReg(0x4e, 0x20);
edodm85 2:354a00023f79 426 WriteReg(0x69, 0x00);
edodm85 2:354a00023f79 427 WriteReg(0x6b, 0x00);
edodm85 2:354a00023f79 428 WriteReg(0x74, 0x19);
edodm85 2:354a00023f79 429 WriteReg(0x8d, 0x4f);
edodm85 2:354a00023f79 430 WriteReg(0x8e, 0x00);
edodm85 2:354a00023f79 431 WriteReg(0x8f, 0x00);
edodm85 2:354a00023f79 432 WriteReg(0x90, 0x00);
edodm85 2:354a00023f79 433 WriteReg(0x91, 0x00);
edodm85 2:354a00023f79 434 WriteReg(0x92, 0x00);
edodm85 2:354a00023f79 435 WriteReg(0x96, 0x00);
edodm85 2:354a00023f79 436 WriteReg(0x9a, 0x80);
edodm85 2:354a00023f79 437 WriteReg(0xb0, 0x84);
edodm85 2:354a00023f79 438 WriteReg(0xb1, 0x0c);
edodm85 2:354a00023f79 439 WriteReg(0xb2, 0x0e);
edodm85 2:354a00023f79 440 WriteReg(0xb3, 0x82);
edodm85 2:354a00023f79 441 WriteReg(0xb8, 0x0a);
edodm85 2:354a00023f79 442 WriteReg(0x43, 0x14);
edodm85 2:354a00023f79 443 WriteReg(0x44, 0xf0);
edodm85 2:354a00023f79 444 WriteReg(0x45, 0x34);
edodm85 2:354a00023f79 445 WriteReg(0x46, 0x58);
edodm85 2:354a00023f79 446 WriteReg(0x47, 0x28);
edodm85 2:354a00023f79 447 WriteReg(0x48, 0x3a);
edodm85 2:354a00023f79 448 WriteReg(0x59, 0x88);
edodm85 2:354a00023f79 449 WriteReg(0x5a, 0x88);
edodm85 2:354a00023f79 450 WriteReg(0x5b, 0x44);
edodm85 2:354a00023f79 451 WriteReg(0x5c, 0x67);
edodm85 2:354a00023f79 452 WriteReg(0x5d, 0x49);
edodm85 2:354a00023f79 453 WriteReg(0x5e, 0x0e);
edodm85 2:354a00023f79 454 WriteReg(0x64, 0x04);
edodm85 2:354a00023f79 455 WriteReg(0x65, 0x20);
edodm85 2:354a00023f79 456 WriteReg(0x66, 0x05);
edodm85 2:354a00023f79 457 WriteReg(0x94, 0x04);
edodm85 2:354a00023f79 458 WriteReg(0x95, 0x08);
edodm85 2:354a00023f79 459 WriteReg(0x6c, 0x0a);
edodm85 2:354a00023f79 460 WriteReg(0x6d, 0x55);
edodm85 2:354a00023f79 461 WriteReg(0x6e, 0x11);
edodm85 2:354a00023f79 462 WriteReg(0x6f, 0x9f);
edodm85 2:354a00023f79 463 WriteReg(0x6a, 0x40);
edodm85 2:354a00023f79 464 WriteReg(0x01, 0x40);
edodm85 2:354a00023f79 465 WriteReg(0x02, 0x40);
edodm85 2:354a00023f79 466 WriteReg(0x13, 0xe7);
edodm85 3:b40a945dd672 467 //WriteReg(0x15, 0x02);
edodm85 2:354a00023f79 468 WriteReg(0x4f, 0x80);
edodm85 2:354a00023f79 469 WriteReg(0x50, 0x80);
edodm85 2:354a00023f79 470 WriteReg(0x51, 0x00);
edodm85 2:354a00023f79 471 WriteReg(0x52, 0x22);
edodm85 2:354a00023f79 472 WriteReg(0x53, 0x5e);
edodm85 2:354a00023f79 473 WriteReg(0x54, 0x80);
edodm85 2:354a00023f79 474 WriteReg(0x58, 0x9e);
edodm85 2:354a00023f79 475 WriteReg(0x41, 0x08);
edodm85 2:354a00023f79 476 WriteReg(0x3f, 0x00);
edodm85 2:354a00023f79 477 WriteReg(0x75, 0x05);
edodm85 2:354a00023f79 478 WriteReg(0x76, 0xe1);
edodm85 2:354a00023f79 479 WriteReg(0x4c, 0x00);
edodm85 2:354a00023f79 480 WriteReg(0x77, 0x01);
edodm85 2:354a00023f79 481 WriteReg(0x3d, 0xc2);
edodm85 2:354a00023f79 482 WriteReg(0x4b, 0x09);
edodm85 2:354a00023f79 483 WriteReg(0xc9, 0x60);
edodm85 2:354a00023f79 484 WriteReg(0x41, 0x38);
edodm85 2:354a00023f79 485 WriteReg(0x56, 0x40);
edodm85 2:354a00023f79 486 WriteReg(0x34, 0x11);
edodm85 2:354a00023f79 487 WriteReg(0x3b, 0x02);
edodm85 2:354a00023f79 488 WriteReg(0xa4, 0x89);
edodm85 2:354a00023f79 489 WriteReg(0x96, 0x00);
edodm85 2:354a00023f79 490 WriteReg(0x97, 0x30);
edodm85 2:354a00023f79 491 WriteReg(0x98, 0x20);
edodm85 2:354a00023f79 492 WriteReg(0x99, 0x30);
edodm85 2:354a00023f79 493 WriteReg(0x9a, 0x84);
edodm85 2:354a00023f79 494 WriteReg(0x9b, 0x29);
edodm85 2:354a00023f79 495 WriteReg(0x9c, 0x03);
edodm85 2:354a00023f79 496 WriteReg(0x9d, 0x4c);
edodm85 2:354a00023f79 497 WriteReg(0x9e, 0x3f);
edodm85 2:354a00023f79 498 WriteReg(0x78, 0x04);
edodm85 2:354a00023f79 499 WriteReg(0x79, 0x01);
edodm85 2:354a00023f79 500 WriteReg(0xc8, 0xf0);
edodm85 2:354a00023f79 501 WriteReg(0x79, 0x0f);
edodm85 2:354a00023f79 502 WriteReg(0xc8, 0x00);
edodm85 2:354a00023f79 503 WriteReg(0x79, 0x10);
edodm85 2:354a00023f79 504 WriteReg(0xc8, 0x7e);
edodm85 2:354a00023f79 505 WriteReg(0x79, 0x0a);
edodm85 2:354a00023f79 506 WriteReg(0xc8, 0x80);
edodm85 2:354a00023f79 507 WriteReg(0x79, 0x0b);
edodm85 2:354a00023f79 508 WriteReg(0xc8, 0x01);
edodm85 2:354a00023f79 509 WriteReg(0x79, 0x0c);
edodm85 2:354a00023f79 510 WriteReg(0xc8, 0x0f);
edodm85 2:354a00023f79 511 WriteReg(0x79, 0x0d);
edodm85 2:354a00023f79 512 WriteReg(0xc8, 0x20);
edodm85 2:354a00023f79 513 WriteReg(0x79, 0x09);
edodm85 2:354a00023f79 514 WriteReg(0xc8, 0x80);
edodm85 2:354a00023f79 515 WriteReg(0x79, 0x02);
edodm85 2:354a00023f79 516 WriteReg(0xc8, 0xc0);
edodm85 2:354a00023f79 517 WriteReg(0x79, 0x03);
edodm85 2:354a00023f79 518 WriteReg(0xc8, 0x40);
edodm85 2:354a00023f79 519 WriteReg(0x79, 0x05);
edodm85 2:354a00023f79 520 WriteReg(0xc8, 0x30);
edodm85 2:354a00023f79 521 WriteReg(0x79, 0x26);
edodm85 2:354a00023f79 522 WriteReg(0x09, 0x03);
edodm85 2:354a00023f79 523 WriteReg(0x3b, 0x42);
edodm85 2:354a00023f79 524
edodm85 2:354a00023f79 525 WriteReg(0xff, 0xff); /* END MARKER */
edodm85 2:354a00023f79 526
edodm85 1:d82dbad9c06b 527 }
edodm85 1:d82dbad9c06b 528 if(n == 307200) // 640*480
edodm85 1:d82dbad9c06b 529 {
edodm85 2:354a00023f79 530 WriteReg(REG_CLKRC, 0x01);
edodm85 2:354a00023f79 531 WriteReg(REG_TSLB, 0x04);
edodm85 2:354a00023f79 532 WriteReg(REG_COM7, 0x01);
edodm85 2:354a00023f79 533 WriteReg(DBLV, 0x4a);
edodm85 2:354a00023f79 534 WriteReg(REG_COM3, 0);
edodm85 2:354a00023f79 535 WriteReg(REG_COM14, 0);
edodm85 2:354a00023f79 536
edodm85 2:354a00023f79 537 WriteReg(REG_HSTART, 0x13);
edodm85 2:354a00023f79 538 WriteReg(REG_HSTOP, 0x01);
edodm85 2:354a00023f79 539 WriteReg(REG_HREF, 0xb6);
edodm85 2:354a00023f79 540 WriteReg(REG_VSTART, 0x02);
edodm85 2:354a00023f79 541 WriteReg(REG_VSTOP, 0x7a);
edodm85 2:354a00023f79 542 WriteReg(REG_VREF, 0x0a);
edodm85 2:354a00023f79 543 WriteReg(0x72, 0x11);
edodm85 2:354a00023f79 544 WriteReg(0x73, 0xf0);
edodm85 2:354a00023f79 545
edodm85 2:354a00023f79 546 /* Gamma curve values */
edodm85 2:354a00023f79 547 WriteReg(0x7a, 0x20);
edodm85 2:354a00023f79 548 WriteReg(0x7b, 0x10);
edodm85 2:354a00023f79 549 WriteReg(0x7c, 0x1e);
edodm85 2:354a00023f79 550 WriteReg(0x7d, 0x35);
edodm85 2:354a00023f79 551 WriteReg(0x7e, 0x5a);
edodm85 2:354a00023f79 552 WriteReg(0x7f, 0x69);
edodm85 2:354a00023f79 553 WriteReg(0x80, 0x76);
edodm85 2:354a00023f79 554 WriteReg(0x81, 0x80);
edodm85 2:354a00023f79 555 WriteReg(0x82, 0x88);
edodm85 2:354a00023f79 556 WriteReg(0x83, 0x8f);
edodm85 2:354a00023f79 557 WriteReg(0x84, 0x96);
edodm85 2:354a00023f79 558 WriteReg(0x85, 0xa3);
edodm85 2:354a00023f79 559 WriteReg(0x86, 0xaf);
edodm85 2:354a00023f79 560 WriteReg(0x87, 0xc4);
edodm85 2:354a00023f79 561 WriteReg(0x88, 0xd7);
edodm85 2:354a00023f79 562 WriteReg(0x89, 0xe8);
edodm85 2:354a00023f79 563
edodm85 2:354a00023f79 564 /* AGC and AEC parameters. Note we start by disabling those features,
edodm85 2:354a00023f79 565 then turn them only after tweaking the values. */
edodm85 2:354a00023f79 566 WriteReg(0x13, COM8_FASTAEC | COM8_AECSTEP | COM8_BFILT);
edodm85 2:354a00023f79 567 WriteReg(0x00, 0);
edodm85 2:354a00023f79 568 WriteReg(0x10, 0);
edodm85 2:354a00023f79 569 WriteReg(0x0d, 0x40);
edodm85 2:354a00023f79 570 WriteReg(0x14, 0x18);
edodm85 2:354a00023f79 571 WriteReg(0xa5, 0x05);
edodm85 2:354a00023f79 572 WriteReg(0xab, 0x07);
edodm85 2:354a00023f79 573 WriteReg(0x24, 0x95);
edodm85 2:354a00023f79 574 WriteReg(0x25, 0x33);
edodm85 2:354a00023f79 575 WriteReg(0x26, 0xe3);
edodm85 2:354a00023f79 576 WriteReg(0x9f, 0x78);
edodm85 2:354a00023f79 577 WriteReg(0xa0, 0x68);
edodm85 2:354a00023f79 578 WriteReg(0xa1, 0x03);
edodm85 2:354a00023f79 579 WriteReg(0xa6, 0xd8);
edodm85 2:354a00023f79 580 WriteReg(0xa7, 0xd8);
edodm85 2:354a00023f79 581 WriteReg(0xa8, 0xf0);
edodm85 2:354a00023f79 582 WriteReg(0xa9, 0x90);
edodm85 2:354a00023f79 583 WriteReg(0xaa, 0x94);
edodm85 2:354a00023f79 584 WriteReg(0x13, COM8_FASTAEC|COM8_AECSTEP|COM8_BFILT|COM8_AGC|COM8_AEC);
edodm85 2:354a00023f79 585
edodm85 2:354a00023f79 586 /* Almost all of these are magic "reserved" values. */
edodm85 2:354a00023f79 587 WriteReg(0x0e, 0x61);
edodm85 2:354a00023f79 588 WriteReg(0x0f, 0x4b);
edodm85 2:354a00023f79 589 WriteReg(0x16, 0x02);
edodm85 2:354a00023f79 590 WriteReg(0x1e, 0x27);
edodm85 2:354a00023f79 591 WriteReg(0x21, 0x02);
edodm85 2:354a00023f79 592 WriteReg(0x22, 0x91);
edodm85 2:354a00023f79 593 WriteReg(0x29, 0x07);
edodm85 2:354a00023f79 594 WriteReg(0x33, 0x0b);
edodm85 2:354a00023f79 595 WriteReg(0x35, 0x0b);
edodm85 2:354a00023f79 596 WriteReg(0x37, 0x1d);
edodm85 2:354a00023f79 597 WriteReg(0x38, 0x71);
edodm85 2:354a00023f79 598 WriteReg(0x39, 0x2a);
edodm85 2:354a00023f79 599 WriteReg(0x3c, 0x78);
edodm85 2:354a00023f79 600 WriteReg(0x4d, 0x40);
edodm85 2:354a00023f79 601 WriteReg(0x4e, 0x20);
edodm85 2:354a00023f79 602 WriteReg(0x69, 0);
edodm85 2:354a00023f79 603 WriteReg(0x6b, 0x0a);
edodm85 2:354a00023f79 604 WriteReg(0x74, 0x10);
edodm85 2:354a00023f79 605 WriteReg(0x8d, 0x4f);
edodm85 2:354a00023f79 606 WriteReg(0x8e, 0);
edodm85 2:354a00023f79 607 WriteReg(0x8f, 0);
edodm85 2:354a00023f79 608 WriteReg(0x90, 0);
edodm85 2:354a00023f79 609 WriteReg(0x91, 0);
edodm85 2:354a00023f79 610 WriteReg(0x96, 0);
edodm85 2:354a00023f79 611 WriteReg(0x9a, 0);
edodm85 2:354a00023f79 612 WriteReg(0xb0, 0x84);
edodm85 2:354a00023f79 613 WriteReg(0xb1, 0x0c);
edodm85 2:354a00023f79 614 WriteReg(0xb2, 0x0e);
edodm85 2:354a00023f79 615 WriteReg(0xb3, 0x82);
edodm85 2:354a00023f79 616 WriteReg(0xb8, 0x0a);
edodm85 2:354a00023f79 617
edodm85 2:354a00023f79 618 /* More reserved magic, some of which tweaks white balance */
edodm85 2:354a00023f79 619 WriteReg(0x43, 0x0a);
edodm85 2:354a00023f79 620 WriteReg(0x44, 0xf0);
edodm85 2:354a00023f79 621 WriteReg(0x45, 0x34);
edodm85 2:354a00023f79 622 WriteReg(0x46, 0x58);
edodm85 2:354a00023f79 623 WriteReg(0x47, 0x28);
edodm85 2:354a00023f79 624 WriteReg(0x48, 0x3a);
edodm85 2:354a00023f79 625 WriteReg(0x59, 0x88);
edodm85 2:354a00023f79 626 WriteReg(0x5a, 0x88);
edodm85 2:354a00023f79 627 WriteReg(0x5b, 0x44);
edodm85 2:354a00023f79 628 WriteReg(0x5c, 0x67);
edodm85 2:354a00023f79 629 WriteReg(0x5d, 0x49);
edodm85 2:354a00023f79 630 WriteReg(0x5e, 0x0e);
edodm85 2:354a00023f79 631 WriteReg(0x6c, 0x0a);
edodm85 2:354a00023f79 632 WriteReg(0x6d, 0x55);
edodm85 2:354a00023f79 633 WriteReg(0x6e, 0x11);
edodm85 2:354a00023f79 634 WriteReg(0x6f, 0x9f);
edodm85 2:354a00023f79 635 WriteReg(0x6a, 0x40);
edodm85 2:354a00023f79 636 WriteReg(0x01, 0x40);
edodm85 2:354a00023f79 637 WriteReg(0x02, 0x60);
edodm85 2:354a00023f79 638 WriteReg(0x13, COM8_FASTAEC|COM8_AECSTEP|COM8_BFILT|COM8_AGC|COM8_AEC|COM8_AWB);
edodm85 2:354a00023f79 639
edodm85 2:354a00023f79 640 /* Matrix coefficients */
edodm85 2:354a00023f79 641 WriteReg(0x4f, 0x80);
edodm85 2:354a00023f79 642 WriteReg(0x50, 0x80);
edodm85 2:354a00023f79 643 WriteReg(0x51, 0);
edodm85 2:354a00023f79 644 WriteReg(0x52, 0x22);
edodm85 2:354a00023f79 645 WriteReg(0x53, 0x5e);
edodm85 2:354a00023f79 646 WriteReg(0x54, 0x80);
edodm85 2:354a00023f79 647 WriteReg(0x58, 0x9e);
edodm85 2:354a00023f79 648
edodm85 2:354a00023f79 649 WriteReg(0x41, 0x08);
edodm85 2:354a00023f79 650 WriteReg(0x3f, 0);
edodm85 2:354a00023f79 651 WriteReg(0x75, 0x05);
edodm85 2:354a00023f79 652 WriteReg(0x76, 0xe1);
edodm85 2:354a00023f79 653 WriteReg(0x4c, 0);
edodm85 2:354a00023f79 654 WriteReg(0x77, 0x01);
edodm85 2:354a00023f79 655 WriteReg(0x3d, 0xc3);
edodm85 2:354a00023f79 656 WriteReg(0x4b, 0x09);
edodm85 2:354a00023f79 657 WriteReg(0xc9, 0x60);
edodm85 2:354a00023f79 658 WriteReg(0x41, 0x38);
edodm85 2:354a00023f79 659 WriteReg(0x56, 0x40);
edodm85 2:354a00023f79 660
edodm85 2:354a00023f79 661 WriteReg(0x34, 0x11);
edodm85 2:354a00023f79 662 WriteReg(0x3b, COM11_EXP|COM11_HZAUTO);
edodm85 2:354a00023f79 663 WriteReg(0xa4, 0x88);
edodm85 2:354a00023f79 664 WriteReg(0x96, 0);
edodm85 2:354a00023f79 665 WriteReg(0x97, 0x30);
edodm85 2:354a00023f79 666 WriteReg(0x98, 0x20);
edodm85 2:354a00023f79 667 WriteReg(0x99, 0x30);
edodm85 2:354a00023f79 668 WriteReg(0x9a, 0x84);
edodm85 2:354a00023f79 669 WriteReg(0x9b, 0x29);
edodm85 2:354a00023f79 670 WriteReg(0x9c, 0x03);
edodm85 2:354a00023f79 671 WriteReg(0x9d, 0x4c);
edodm85 2:354a00023f79 672 WriteReg(0x9e, 0x3f);
edodm85 2:354a00023f79 673 WriteReg(0x78, 0x04);
edodm85 2:354a00023f79 674
edodm85 2:354a00023f79 675 /* Extra-weird stuff. Some sort of multiplexor register */
edodm85 2:354a00023f79 676 WriteReg(0x79, 0x01);
edodm85 2:354a00023f79 677 WriteReg(0xc8, 0xf0);
edodm85 2:354a00023f79 678 WriteReg(0x79, 0x0f);
edodm85 2:354a00023f79 679 WriteReg(0xc8, 0x00);
edodm85 2:354a00023f79 680 WriteReg(0x79, 0x10);
edodm85 2:354a00023f79 681 WriteReg(0xc8, 0x7e);
edodm85 2:354a00023f79 682 WriteReg(0x79, 0x0a);
edodm85 2:354a00023f79 683 WriteReg(0xc8, 0x80);
edodm85 2:354a00023f79 684 WriteReg(0x79, 0x0b);
edodm85 2:354a00023f79 685 WriteReg(0xc8, 0x01);
edodm85 2:354a00023f79 686 WriteReg(0x79, 0x0c);
edodm85 2:354a00023f79 687 WriteReg(0xc8, 0x0f);
edodm85 2:354a00023f79 688 WriteReg(0x79, 0x0d);
edodm85 2:354a00023f79 689 WriteReg(0xc8, 0x20);
edodm85 2:354a00023f79 690 WriteReg(0x79, 0x09);
edodm85 2:354a00023f79 691 WriteReg(0xc8, 0x80);
edodm85 2:354a00023f79 692 WriteReg(0x79, 0x02);
edodm85 2:354a00023f79 693 WriteReg(0xc8, 0xc0);
edodm85 2:354a00023f79 694 WriteReg(0x79, 0x03);
edodm85 2:354a00023f79 695 WriteReg(0xc8, 0x40);
edodm85 2:354a00023f79 696 WriteReg(0x79, 0x05);
edodm85 2:354a00023f79 697 WriteReg(0xc8, 0x30);
edodm85 2:354a00023f79 698 WriteReg(0x79, 0x26);
edodm85 2:354a00023f79 699
edodm85 2:354a00023f79 700 WriteReg(0xff, 0xff); /* END MARKER */
edodm85 1:d82dbad9c06b 701 }
edodm85 1:d82dbad9c06b 702
edodm85 0:810d59d0b843 703 return 1;
edodm85 0:810d59d0b843 704 }
edodm85 0:810d59d0b843 705
edodm85 3:b40a945dd672 706
edodm85 3:b40a945dd672 707
edodm85 3:b40a945dd672 708
edodm85 3:b40a945dd672 709 // write to camera
edodm85 3:b40a945dd672 710 void OV7670::WriteReg(int addr,int data)
edodm85 0:810d59d0b843 711 {
edodm85 3:b40a945dd672 712 _i2c.start();
edodm85 3:b40a945dd672 713 _i2c.write(OV7670_WRITE);
edodm85 3:b40a945dd672 714 wait_us(OV7670_WRITEWAIT);
edodm85 3:b40a945dd672 715 _i2c.write(addr);
edodm85 3:b40a945dd672 716 wait_us(OV7670_WRITEWAIT);
edodm85 3:b40a945dd672 717 _i2c.write(data);
edodm85 3:b40a945dd672 718 _i2c.stop();
edodm85 0:810d59d0b843 719 }
edodm85 0:810d59d0b843 720
edodm85 3:b40a945dd672 721 // read from camera
edodm85 3:b40a945dd672 722 int OV7670::ReadReg(int addr)
edodm85 0:810d59d0b843 723 {
edodm85 3:b40a945dd672 724 int data;
edodm85 3:b40a945dd672 725
edodm85 3:b40a945dd672 726 _i2c.start();
edodm85 3:b40a945dd672 727 _i2c.write(OV7670_WRITE);
edodm85 3:b40a945dd672 728 wait_us(OV7670_WRITEWAIT);
edodm85 3:b40a945dd672 729 _i2c.write(addr);
edodm85 3:b40a945dd672 730 _i2c.stop();
edodm85 3:b40a945dd672 731 wait_us(OV7670_WRITEWAIT);
edodm85 0:810d59d0b843 732
edodm85 3:b40a945dd672 733 _i2c.start();
edodm85 3:b40a945dd672 734 _i2c.write(OV7670_READ);
edodm85 3:b40a945dd672 735 wait_us(OV7670_WRITEWAIT);
edodm85 3:b40a945dd672 736 data = _i2c.read(OV7670_NOACK);
edodm85 3:b40a945dd672 737 _i2c.stop();
edodm85 0:810d59d0b843 738
edodm85 3:b40a945dd672 739 return data;
edodm85 0:810d59d0b843 740 }