Diff: OC7670.cpp

Revision:

0:f309a2b2f27b

Child:

1:6e4d2cff76e8

--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/OC7670.cpp	Mon Jul 22 23:55:34 2013 +0000
@@ -0,0 +1,170 @@
+#include "OV7670.h"
+
+OV7670::OV7670(
+    PinName sda, // Camera I2C port
+    PinName scl, // Camera I2C port
+    PinName xclk,// Camera XCLK
+    PinName pclkPin,// PCLK
+    PinName vs,  // VSYNC
+    PinName hr,  // HREF
+    
+    PortName port, // 8bit bus port
+    int mask // 0000 0111 4000 0111 1000 0000 0000 0000 = 0x07878000
+    
+    ) : camera(sda,scl), data(port, mask), inPort(Port2, 0x0000001C)
+{
+    camera.stop();
+    camera.frequency(OV7670_I2CFREQ);
+    CaptureReq = false;
+    Busy = false;
+    Done = false;
+    LineCounter = 0;
+    xclkPin = xclk;
+}
+
+void OV7670::Init() {
+    FastPWM clkOut(xclkPin);
+    double pclk_period_us = (1.0 / 16000000.0)*1000000;
+    clkOut.period_us(pclk_period_us);
+    clkOut.pulsewidth_us(pclk_period_us/2.0);
+    wait_ms(50);
+}
+
+void OV7670::WriteReg(int addr, int data) {
+    // WRITE 0x42, ADDR, DATA
+    camera.start();
+    camera.write(OV7670_WRITE);
+    wait_us(OV7670_WRITEWAIT);
+    camera.write(addr);
+    wait_us(OV7670_WRITEWAIT);
+    camera.write(data);
+    camera.stop();
+}
+
+int OV7670::ReadReg(int addr) {
+    int data;
+
+    // WRITE 0x42,ADDR
+    camera.start();
+    camera.write(OV7670_WRITE);
+    wait_us(OV7670_WRITEWAIT);
+    camera.write(addr);
+    camera.stop();
+    wait_us(OV7670_WRITEWAIT);    
+
+    // WRITE 0x43,READ
+    camera.start();
+    camera.write(OV7670_READ);
+    wait_us(OV7670_WRITEWAIT);
+    data = camera.read(OV7670_NOACK);
+    camera.stop();
+
+    return data;
+}
+
+void OV7670::Reset(void) {    
+    WriteReg(0x12,0x80) ; // RESET CAMERA
+    wait_ms(200) ;
+}
+
+void OV7670::InitQQVGA() {
+    // QQVGA RGB444
+    WriteReg(REG_CLKRC,0x03);
+    WriteReg(REG_COM11,0x0A) ;
+    WriteReg(REG_TSLB,0x04);
+    WriteReg(REG_COM7,0x04) ;
+    
+    WriteReg(REG_RGB444, 0x00);     // Disable RGB 444?
+    WriteReg(REG_COM15, 0xD0);      // Set RGB 565?
+    
+    WriteReg(REG_HSTART,0x16) ;
+    WriteReg(REG_HSTOP,0x04) ;
+    WriteReg(REG_HREF,0x24) ;
+    WriteReg(REG_VSTART,0x02) ;
+    WriteReg(REG_VSTOP,0x7a) ;
+    WriteReg(REG_VREF,0x0a) ;
+    WriteReg(REG_COM10,0x02) ;
+    WriteReg(REG_COM3, 0x04);
+    WriteReg(REG_COM14, 0x1a);
+    WriteReg(REG_MVFP,0x27) ;
+    WriteReg(0x72, 0x22);
+    WriteReg(0x73, 0xf2);
+
+    // COLOR SETTING
+    WriteReg(0x4f,0x80);
+    WriteReg(0x50,0x80);
+    WriteReg(0x51,0x00);
+    WriteReg(0x52,0x22);
+    WriteReg(0x53,0x5e);
+    WriteReg(0x54,0x80);
+    WriteReg(0x56,0x40);
+    WriteReg(0x58,0x9e);
+    WriteReg(0x59,0x88);
+    WriteReg(0x5a,0x88);
+    WriteReg(0x5b,0x44);
+    WriteReg(0x5c,0x67);
+    WriteReg(0x5d,0x49);
+    WriteReg(0x5e,0x0e);
+    WriteReg(0x69,0x00);
+    WriteReg(0x6a,0x40);
+    WriteReg(0x6b,0x0a);
+    WriteReg(0x6c,0x0a);
+    WriteReg(0x6d,0x55);
+    WriteReg(0x6e,0x11);
+    WriteReg(0x6f,0x9f);
+
+    WriteReg(0xb0,0x84);
+}
+
+void OV7670::scopeTest(Serial *host) {
+    Timer t1, t2;
+    int LED = 0x80000000;
+    PortInOut status(Port1, LED);
+    status = LED;
+    int cycles = 1000000;
+    while(inPort & 0x00000008) {};
+    while(!(inPort & 0x00000008)) {};
+    t1.start();
+    while(cycles--) {
+        while(!(inPort & 0x00000010)) {};
+        while(inPort & 0x00000010) {};
+    }
+    status = 0;
+    t1.stop();
+    printf("One million cycles: %d\n\r", t1.read_us());
+    //printf("Avg on, off = %d, %d\n\r", t1.read_us()/100, t2.read_us()/100);
+}
+
+int OV7670::captureImage(unsigned char *arr1, unsigned char* arr2) {
+    int d, i=0;
+    int byte = 0;
+    Timer t1;
+    // Read in the first half of the image
+    while(inPort & 0x00000008) {};    // Wait for VSYNC low
+    while(!(inPort & 0x00000008)) {}; // Wait for VSYNC high
+    //t1.start();
+    while(inPort & 0x00000008) {      // While VSYNC high
+        while((inPort & 0x00000008) && !(inPort & 0x00000004)) {};  // stall while VSYNC high and HREF low
+        if(!(inPort & 0x00000008)) {                  // if VSYNC low
+            //printf("Interrupted!\n\r");
+            break;
+        }
+        while (inPort & 0x00000004) {       // While HREF high
+            while(!(inPort & 0x00000010)) {};  // Wait for PCLK high
+            d = data;
+            byte  = (d & 0x07800000) >> 19; // bit26 to bit7
+            byte |= (d & 0x00078000) >> 15; // bit18 to bit3
+            arr1[i] = byte;
+            while(inPort & 0x00000010) {};        // Wait for PCLK low
+            while(!(inPort & 0x00000010)) {};  // Wait for PCLK high
+            d = data;
+            byte  = (d & 0x07800000) >> 19; // bit26 to bit7
+            byte |= (d & 0x00078000) >> 15; // bit18 to bit3
+            arr2[i++] = byte;
+            while(inPort & 0x00000010) {}; 
+        }
+    }
+    //printf("Image read: %d\n\r", t1.read_us());
+    return i*2;
+}
+    
\ No newline at end of file