Sebastian Barrera / ov7670_lib

ov7670 library

Dependents:   Project_test Capture_bw_portin Capture_bw_v3 Project_190659132

ov7670.cpp@5:46b8114bb5dd, 2020-04-06 (annotated)

Committer:
sebbarpar
Date:
Mon Apr 06 10:07:45 2020 +0000
Revision:
5:46b8114bb5dd
Parent:
3:b40a945dd672
Child:
6:b1b77891bddf
Testing;

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