Samuel Pullman / Mbed 2 deprecated CameraTest

OV7670 + 23LC1024 + Bluetooth

Dependencies:   FastPWM MODSERIAL mbed

OC7670.cpp@0:f309a2b2f27b, 2013-07-22 (annotated)

Committer:
sampullman
Date:
Mon Jul 22 23:55:34 2013 +0000
Revision:
0:f309a2b2f27b
Child:
1:6e4d2cff76e8
Successful OV7670 camera test with QQVGA resolution and no peripherals.

Who changed what in which revision?

UserRevisionLine numberNew contents of line
sampullman 0:f309a2b2f27b 1 #include "OV7670.h"
sampullman 0:f309a2b2f27b 2
sampullman 0:f309a2b2f27b 3 OV7670::OV7670(
sampullman 0:f309a2b2f27b 4 PinName sda, // Camera I2C port
sampullman 0:f309a2b2f27b 5 PinName scl, // Camera I2C port
sampullman 0:f309a2b2f27b 6 PinName xclk,// Camera XCLK
sampullman 0:f309a2b2f27b 7 PinName pclkPin,// PCLK
sampullman 0:f309a2b2f27b 8 PinName vs, // VSYNC
sampullman 0:f309a2b2f27b 9 PinName hr, // HREF
sampullman 0:f309a2b2f27b 10
sampullman 0:f309a2b2f27b 11 PortName port, // 8bit bus port
sampullman 0:f309a2b2f27b 12 int mask // 0000 0111 4000 0111 1000 0000 0000 0000 = 0x07878000
sampullman 0:f309a2b2f27b 13
sampullman 0:f309a2b2f27b 14 ) : camera(sda,scl), data(port, mask), inPort(Port2, 0x0000001C)
sampullman 0:f309a2b2f27b 15 {
sampullman 0:f309a2b2f27b 16 camera.stop();
sampullman 0:f309a2b2f27b 17 camera.frequency(OV7670_I2CFREQ);
sampullman 0:f309a2b2f27b 18 CaptureReq = false;
sampullman 0:f309a2b2f27b 19 Busy = false;
sampullman 0:f309a2b2f27b 20 Done = false;
sampullman 0:f309a2b2f27b 21 LineCounter = 0;
sampullman 0:f309a2b2f27b 22 xclkPin = xclk;
sampullman 0:f309a2b2f27b 23 }
sampullman 0:f309a2b2f27b 24
sampullman 0:f309a2b2f27b 25 void OV7670::Init() {
sampullman 0:f309a2b2f27b 26 FastPWM clkOut(xclkPin);
sampullman 0:f309a2b2f27b 27 double pclk_period_us = (1.0 / 16000000.0)*1000000;
sampullman 0:f309a2b2f27b 28 clkOut.period_us(pclk_period_us);
sampullman 0:f309a2b2f27b 29 clkOut.pulsewidth_us(pclk_period_us/2.0);
sampullman 0:f309a2b2f27b 30 wait_ms(50);
sampullman 0:f309a2b2f27b 31 }
sampullman 0:f309a2b2f27b 32
sampullman 0:f309a2b2f27b 33 void OV7670::WriteReg(int addr, int data) {
sampullman 0:f309a2b2f27b 34 // WRITE 0x42, ADDR, DATA
sampullman 0:f309a2b2f27b 35 camera.start();
sampullman 0:f309a2b2f27b 36 camera.write(OV7670_WRITE);
sampullman 0:f309a2b2f27b 37 wait_us(OV7670_WRITEWAIT);
sampullman 0:f309a2b2f27b 38 camera.write(addr);
sampullman 0:f309a2b2f27b 39 wait_us(OV7670_WRITEWAIT);
sampullman 0:f309a2b2f27b 40 camera.write(data);
sampullman 0:f309a2b2f27b 41 camera.stop();
sampullman 0:f309a2b2f27b 42 }
sampullman 0:f309a2b2f27b 43
sampullman 0:f309a2b2f27b 44 int OV7670::ReadReg(int addr) {
sampullman 0:f309a2b2f27b 45 int data;
sampullman 0:f309a2b2f27b 46
sampullman 0:f309a2b2f27b 47 // WRITE 0x42,ADDR
sampullman 0:f309a2b2f27b 48 camera.start();
sampullman 0:f309a2b2f27b 49 camera.write(OV7670_WRITE);
sampullman 0:f309a2b2f27b 50 wait_us(OV7670_WRITEWAIT);
sampullman 0:f309a2b2f27b 51 camera.write(addr);
sampullman 0:f309a2b2f27b 52 camera.stop();
sampullman 0:f309a2b2f27b 53 wait_us(OV7670_WRITEWAIT);
sampullman 0:f309a2b2f27b 54
sampullman 0:f309a2b2f27b 55 // WRITE 0x43,READ
sampullman 0:f309a2b2f27b 56 camera.start();
sampullman 0:f309a2b2f27b 57 camera.write(OV7670_READ);
sampullman 0:f309a2b2f27b 58 wait_us(OV7670_WRITEWAIT);
sampullman 0:f309a2b2f27b 59 data = camera.read(OV7670_NOACK);
sampullman 0:f309a2b2f27b 60 camera.stop();
sampullman 0:f309a2b2f27b 61
sampullman 0:f309a2b2f27b 62 return data;
sampullman 0:f309a2b2f27b 63 }
sampullman 0:f309a2b2f27b 64
sampullman 0:f309a2b2f27b 65 void OV7670::Reset(void) {
sampullman 0:f309a2b2f27b 66 WriteReg(0x12,0x80) ; // RESET CAMERA
sampullman 0:f309a2b2f27b 67 wait_ms(200) ;
sampullman 0:f309a2b2f27b 68 }
sampullman 0:f309a2b2f27b 69
sampullman 0:f309a2b2f27b 70 void OV7670::InitQQVGA() {
sampullman 0:f309a2b2f27b 71 // QQVGA RGB444
sampullman 0:f309a2b2f27b 72 WriteReg(REG_CLKRC,0x03);
sampullman 0:f309a2b2f27b 73 WriteReg(REG_COM11,0x0A) ;
sampullman 0:f309a2b2f27b 74 WriteReg(REG_TSLB,0x04);
sampullman 0:f309a2b2f27b 75 WriteReg(REG_COM7,0x04) ;
sampullman 0:f309a2b2f27b 76
sampullman 0:f309a2b2f27b 77 WriteReg(REG_RGB444, 0x00); // Disable RGB 444?
sampullman 0:f309a2b2f27b 78 WriteReg(REG_COM15, 0xD0); // Set RGB 565?
sampullman 0:f309a2b2f27b 79
sampullman 0:f309a2b2f27b 80 WriteReg(REG_HSTART,0x16) ;
sampullman 0:f309a2b2f27b 81 WriteReg(REG_HSTOP,0x04) ;
sampullman 0:f309a2b2f27b 82 WriteReg(REG_HREF,0x24) ;
sampullman 0:f309a2b2f27b 83 WriteReg(REG_VSTART,0x02) ;
sampullman 0:f309a2b2f27b 84 WriteReg(REG_VSTOP,0x7a) ;
sampullman 0:f309a2b2f27b 85 WriteReg(REG_VREF,0x0a) ;
sampullman 0:f309a2b2f27b 86 WriteReg(REG_COM10,0x02) ;
sampullman 0:f309a2b2f27b 87 WriteReg(REG_COM3, 0x04);
sampullman 0:f309a2b2f27b 88 WriteReg(REG_COM14, 0x1a);
sampullman 0:f309a2b2f27b 89 WriteReg(REG_MVFP,0x27) ;
sampullman 0:f309a2b2f27b 90 WriteReg(0x72, 0x22);
sampullman 0:f309a2b2f27b 91 WriteReg(0x73, 0xf2);
sampullman 0:f309a2b2f27b 92
sampullman 0:f309a2b2f27b 93 // COLOR SETTING
sampullman 0:f309a2b2f27b 94 WriteReg(0x4f,0x80);
sampullman 0:f309a2b2f27b 95 WriteReg(0x50,0x80);
sampullman 0:f309a2b2f27b 96 WriteReg(0x51,0x00);
sampullman 0:f309a2b2f27b 97 WriteReg(0x52,0x22);
sampullman 0:f309a2b2f27b 98 WriteReg(0x53,0x5e);
sampullman 0:f309a2b2f27b 99 WriteReg(0x54,0x80);
sampullman 0:f309a2b2f27b 100 WriteReg(0x56,0x40);
sampullman 0:f309a2b2f27b 101 WriteReg(0x58,0x9e);
sampullman 0:f309a2b2f27b 102 WriteReg(0x59,0x88);
sampullman 0:f309a2b2f27b 103 WriteReg(0x5a,0x88);
sampullman 0:f309a2b2f27b 104 WriteReg(0x5b,0x44);
sampullman 0:f309a2b2f27b 105 WriteReg(0x5c,0x67);
sampullman 0:f309a2b2f27b 106 WriteReg(0x5d,0x49);
sampullman 0:f309a2b2f27b 107 WriteReg(0x5e,0x0e);
sampullman 0:f309a2b2f27b 108 WriteReg(0x69,0x00);
sampullman 0:f309a2b2f27b 109 WriteReg(0x6a,0x40);
sampullman 0:f309a2b2f27b 110 WriteReg(0x6b,0x0a);
sampullman 0:f309a2b2f27b 111 WriteReg(0x6c,0x0a);
sampullman 0:f309a2b2f27b 112 WriteReg(0x6d,0x55);
sampullman 0:f309a2b2f27b 113 WriteReg(0x6e,0x11);
sampullman 0:f309a2b2f27b 114 WriteReg(0x6f,0x9f);
sampullman 0:f309a2b2f27b 115
sampullman 0:f309a2b2f27b 116 WriteReg(0xb0,0x84);
sampullman 0:f309a2b2f27b 117 }
sampullman 0:f309a2b2f27b 118
sampullman 0:f309a2b2f27b 119 void OV7670::scopeTest(Serial *host) {
sampullman 0:f309a2b2f27b 120 Timer t1, t2;
sampullman 0:f309a2b2f27b 121 int LED = 0x80000000;
sampullman 0:f309a2b2f27b 122 PortInOut status(Port1, LED);
sampullman 0:f309a2b2f27b 123 status = LED;
sampullman 0:f309a2b2f27b 124 int cycles = 1000000;
sampullman 0:f309a2b2f27b 125 while(inPort & 0x00000008) {};
sampullman 0:f309a2b2f27b 126 while(!(inPort & 0x00000008)) {};
sampullman 0:f309a2b2f27b 127 t1.start();
sampullman 0:f309a2b2f27b 128 while(cycles--) {
sampullman 0:f309a2b2f27b 129 while(!(inPort & 0x00000010)) {};
sampullman 0:f309a2b2f27b 130 while(inPort & 0x00000010) {};
sampullman 0:f309a2b2f27b 131 }
sampullman 0:f309a2b2f27b 132 status = 0;
sampullman 0:f309a2b2f27b 133 t1.stop();
sampullman 0:f309a2b2f27b 134 printf("One million cycles: %d\n\r", t1.read_us());
sampullman 0:f309a2b2f27b 135 //printf("Avg on, off = %d, %d\n\r", t1.read_us()/100, t2.read_us()/100);
sampullman 0:f309a2b2f27b 136 }
sampullman 0:f309a2b2f27b 137
sampullman 0:f309a2b2f27b 138 int OV7670::captureImage(unsigned char *arr1, unsigned char* arr2) {
sampullman 0:f309a2b2f27b 139 int d, i=0;
sampullman 0:f309a2b2f27b 140 int byte = 0;
sampullman 0:f309a2b2f27b 141 Timer t1;
sampullman 0:f309a2b2f27b 142 // Read in the first half of the image
sampullman 0:f309a2b2f27b 143 while(inPort & 0x00000008) {}; // Wait for VSYNC low
sampullman 0:f309a2b2f27b 144 while(!(inPort & 0x00000008)) {}; // Wait for VSYNC high
sampullman 0:f309a2b2f27b 145 //t1.start();
sampullman 0:f309a2b2f27b 146 while(inPort & 0x00000008) { // While VSYNC high
sampullman 0:f309a2b2f27b 147 while((inPort & 0x00000008) && !(inPort & 0x00000004)) {}; // stall while VSYNC high and HREF low
sampullman 0:f309a2b2f27b 148 if(!(inPort & 0x00000008)) { // if VSYNC low
sampullman 0:f309a2b2f27b 149 //printf("Interrupted!\n\r");
sampullman 0:f309a2b2f27b 150 break;
sampullman 0:f309a2b2f27b 151 }
sampullman 0:f309a2b2f27b 152 while (inPort & 0x00000004) { // While HREF high
sampullman 0:f309a2b2f27b 153 while(!(inPort & 0x00000010)) {}; // Wait for PCLK high
sampullman 0:f309a2b2f27b 154 d = data;
sampullman 0:f309a2b2f27b 155 byte = (d & 0x07800000) >> 19; // bit26 to bit7
sampullman 0:f309a2b2f27b 156 byte |= (d & 0x00078000) >> 15; // bit18 to bit3
sampullman 0:f309a2b2f27b 157 arr1[i] = byte;
sampullman 0:f309a2b2f27b 158 while(inPort & 0x00000010) {}; // Wait for PCLK low
sampullman 0:f309a2b2f27b 159 while(!(inPort & 0x00000010)) {}; // Wait for PCLK high
sampullman 0:f309a2b2f27b 160 d = data;
sampullman 0:f309a2b2f27b 161 byte = (d & 0x07800000) >> 19; // bit26 to bit7
sampullman 0:f309a2b2f27b 162 byte |= (d & 0x00078000) >> 15; // bit18 to bit3
sampullman 0:f309a2b2f27b 163 arr2[i++] = byte;
sampullman 0:f309a2b2f27b 164 while(inPort & 0x00000010) {};
sampullman 0:f309a2b2f27b 165 }
sampullman 0:f309a2b2f27b 166 }
sampullman 0:f309a2b2f27b 167 //printf("Image read: %d\n\r", t1.read_us());
sampullman 0:f309a2b2f27b 168 return i*2;
sampullman 0:f309a2b2f27b 169 }
sampullman 0:f309a2b2f27b 170