Edoardo De Marchi / Mbed 2 deprecated OV7670_Test_Code_with_ethernet

Test Code for OV7670 Camera module. The images are sent over ethernet link.

Dependencies:   EthernetInterface mbed-rtos mbed ov7670

You can find more information in this page: https://mbed.org/users/edodm85/notebook/ov7670-camera-and-ethernet-stream/

main.cpp@0:2208b72b1ba1, 2013-07-15 (annotated)

Committer:
edodm85
Date:
Mon Jul 15 20:51:31 2013 +0000
Revision:
0:2208b72b1ba1
Child:
1:0e4d23df43ea
First Rev

Who changed what in which revision?

UserRevisionLine numberNew contents of line
edodm85 0:2208b72b1ba1 1 /*
edodm85 0:2208b72b1ba1 2 * Author: Edoardo De Marchi
edodm85 0:2208b72b1ba1 3 * Date: 15/07/13
edodm85 0:2208b72b1ba1 4 * Notes: OV7670 camera with Ethernet Connection
edodm85 0:2208b72b1ba1 5 */
edodm85 0:2208b72b1ba1 6
edodm85 0:2208b72b1ba1 7 #include "main.h"
edodm85 0:2208b72b1ba1 8
edodm85 0:2208b72b1ba1 9 #define VGA 307200 //640*480
edodm85 0:2208b72b1ba1 10 #define QVGA 76800 //320*240
edodm85 0:2208b72b1ba1 11 #define QQVGA 19200 //160*120
edodm85 0:2208b72b1ba1 12
edodm85 0:2208b72b1ba1 13 static char format = ' ';
edodm85 0:2208b72b1ba1 14 static int resolution = 0;
edodm85 0:2208b72b1ba1 15
edodm85 0:2208b72b1ba1 16
edodm85 0:2208b72b1ba1 17 int Init()
edodm85 0:2208b72b1ba1 18 {
edodm85 0:2208b72b1ba1 19 led1 = 0;
edodm85 0:2208b72b1ba1 20 led2 = 0; // mbed status
edodm85 0:2208b72b1ba1 21 led3 = 0; // Ethernet link enable/disable
edodm85 0:2208b72b1ba1 22 led4 = 0;
edodm85 0:2208b72b1ba1 23
edodm85 0:2208b72b1ba1 24
edodm85 0:2208b72b1ba1 25
edodm85 0:2208b72b1ba1 26 //ETHERNET
edodm85 0:2208b72b1ba1 27 eth.init(ip, mask, gateway);
edodm85 0:2208b72b1ba1 28 eth.connect();
edodm85 0:2208b72b1ba1 29 server.bind(ECHO_SERVER_PORT);
edodm85 0:2208b72b1ba1 30 server.listen(1);
edodm85 0:2208b72b1ba1 31 printf("IP Address is %s\r\n", eth.getIPAddress());
edodm85 0:2208b72b1ba1 32
edodm85 0:2208b72b1ba1 33 //THREAD
edodm85 0:2208b72b1ba1 34 osThreadCreate(osThread(net_thread), NULL);
edodm85 0:2208b72b1ba1 35
edodm85 0:2208b72b1ba1 36 return 0;
edodm85 0:2208b72b1ba1 37 }
edodm85 0:2208b72b1ba1 38
edodm85 0:2208b72b1ba1 39
edodm85 0:2208b72b1ba1 40
edodm85 0:2208b72b1ba1 41 int main (void)
edodm85 0:2208b72b1ba1 42 {
edodm85 0:2208b72b1ba1 43 Init();
edodm85 0:2208b72b1ba1 44
edodm85 0:2208b72b1ba1 45 t.start();
edodm85 0:2208b72b1ba1 46
edodm85 0:2208b72b1ba1 47 while (true)
edodm85 0:2208b72b1ba1 48 {
edodm85 0:2208b72b1ba1 49 //mbed is alive?
edodm85 0:2208b72b1ba1 50 led2 = !led2;
edodm85 0:2208b72b1ba1 51 osDelay(500);
edodm85 0:2208b72b1ba1 52 }
edodm85 0:2208b72b1ba1 53 }
edodm85 0:2208b72b1ba1 54
edodm85 0:2208b72b1ba1 55
edodm85 0:2208b72b1ba1 56 void net_thread(void const *argument)
edodm85 0:2208b72b1ba1 57 {
edodm85 0:2208b72b1ba1 58 while (true)
edodm85 0:2208b72b1ba1 59 {
edodm85 0:2208b72b1ba1 60 led3 = 1;
edodm85 0:2208b72b1ba1 61 ////printf("\r\nWait for new connection...\r\n");
edodm85 0:2208b72b1ba1 62 server.accept(client);
edodm85 0:2208b72b1ba1 63 //printf("Connection from: %s\r\n", client.get_address());
edodm85 0:2208b72b1ba1 64 while (true)
edodm85 0:2208b72b1ba1 65 {
edodm85 0:2208b72b1ba1 66 led3 = 0;
edodm85 0:2208b72b1ba1 67 int n = client.receive(bufferRX, sizeof(bufferRX));
edodm85 0:2208b72b1ba1 68 if (n <= 0) break;
edodm85 0:2208b72b1ba1 69
edodm85 0:2208b72b1ba1 70 bufferRX[n]=0; // make terminater
edodm85 0:2208b72b1ba1 71 parse_cmd();
edodm85 0:2208b72b1ba1 72 }
edodm85 0:2208b72b1ba1 73 client.close();
edodm85 0:2208b72b1ba1 74 //printf("Connection close.\r\n");
edodm85 0:2208b72b1ba1 75 }
edodm85 0:2208b72b1ba1 76 }
edodm85 0:2208b72b1ba1 77
edodm85 0:2208b72b1ba1 78
edodm85 0:2208b72b1ba1 79 void Send()
edodm85 0:2208b72b1ba1 80 {
edodm85 0:2208b72b1ba1 81 client.send_all(bufferTX, sizeof(bufferTX));
edodm85 0:2208b72b1ba1 82 memset(bufferTX, 0, sizeof(bufferTX));
edodm85 0:2208b72b1ba1 83 }
edodm85 0:2208b72b1ba1 84
edodm85 0:2208b72b1ba1 85
edodm85 0:2208b72b1ba1 86 void parse_cmd(){
edodm85 0:2208b72b1ba1 87 new_send = false;
edodm85 0:2208b72b1ba1 88
edodm85 0:2208b72b1ba1 89 if(strcmp("snap", bufferRX) == 0)
edodm85 0:2208b72b1ba1 90 {
edodm85 0:2208b72b1ba1 91 CameraSnap();
edodm85 0:2208b72b1ba1 92 memset(bufferRX, 0, sizeof(bufferRX));
edodm85 0:2208b72b1ba1 93 }else
edodm85 0:2208b72b1ba1 94 if(strcmp("init_bw_VGA", bufferRX) == 0) // Set up for 640*480 pixels RAW
edodm85 0:2208b72b1ba1 95 {
edodm85 0:2208b72b1ba1 96 format = 'b';
edodm85 0:2208b72b1ba1 97 resolution = VGA;
edodm85 0:2208b72b1ba1 98 if(camera.Init('b', VGA) != 1)
edodm85 0:2208b72b1ba1 99 {
edodm85 0:2208b72b1ba1 100 printf("Init Fail\r\n");
edodm85 0:2208b72b1ba1 101 }
edodm85 0:2208b72b1ba1 102 memset(bufferRX, 0, sizeof(bufferRX));
edodm85 0:2208b72b1ba1 103 }else
edodm85 0:2208b72b1ba1 104 if(strcmp("init_yuv_QVGA", bufferRX) == 0) // Set up for 320*240 pixels YUV422
edodm85 0:2208b72b1ba1 105 {
edodm85 0:2208b72b1ba1 106 format = 'y';
edodm85 0:2208b72b1ba1 107 resolution = QVGA;
edodm85 0:2208b72b1ba1 108 if(camera.Init('b', QVGA) != 1)
edodm85 0:2208b72b1ba1 109 {
edodm85 0:2208b72b1ba1 110 printf("Init Fail\r\n");
edodm85 0:2208b72b1ba1 111 }
edodm85 0:2208b72b1ba1 112 memset(bufferRX, 0, sizeof(bufferRX));
edodm85 0:2208b72b1ba1 113 }else
edodm85 0:2208b72b1ba1 114 if(strcmp("init_rgb_QVGA", bufferRX) == 0) // Set up for 320*240 pixels RGB565
edodm85 0:2208b72b1ba1 115 {
edodm85 0:2208b72b1ba1 116 format = 'r';
edodm85 0:2208b72b1ba1 117 resolution = QVGA;
edodm85 0:2208b72b1ba1 118 if(camera.Init('r', QVGA) != 1)
edodm85 0:2208b72b1ba1 119 {
edodm85 0:2208b72b1ba1 120 printf("Init Fail\r\n");
edodm85 0:2208b72b1ba1 121 }
edodm85 0:2208b72b1ba1 122 memset(bufferRX, 0, sizeof(bufferRX));
edodm85 0:2208b72b1ba1 123 }else
edodm85 0:2208b72b1ba1 124 if(strcmp("init_bw_QVGA", bufferRX) == 0) // Set up for 320*240 pixels YUV (Only Y)
edodm85 0:2208b72b1ba1 125 {
edodm85 0:2208b72b1ba1 126 format = 'b';
edodm85 0:2208b72b1ba1 127 resolution = QVGA;
edodm85 0:2208b72b1ba1 128 if(camera.Init('b', QVGA) != 1)
edodm85 0:2208b72b1ba1 129 {
edodm85 0:2208b72b1ba1 130 printf("Init Fail\r\n");
edodm85 0:2208b72b1ba1 131 }
edodm85 0:2208b72b1ba1 132 memset(bufferRX, 0, sizeof(bufferRX));
edodm85 0:2208b72b1ba1 133 }else
edodm85 0:2208b72b1ba1 134 if(strcmp("init_yuv_QQVGA", bufferRX) == 0) // Set up for 160*120 pixels YUV422
edodm85 0:2208b72b1ba1 135 {
edodm85 0:2208b72b1ba1 136 format = 'y';
edodm85 0:2208b72b1ba1 137 resolution = QQVGA;
edodm85 0:2208b72b1ba1 138 if(camera.Init('b', QQVGA) != 1)
edodm85 0:2208b72b1ba1 139 {
edodm85 0:2208b72b1ba1 140 printf("Init Fail\r\n");
edodm85 0:2208b72b1ba1 141 }
edodm85 0:2208b72b1ba1 142 memset(bufferRX, 0, sizeof(bufferRX));
edodm85 0:2208b72b1ba1 143 }else
edodm85 0:2208b72b1ba1 144 if(strcmp("init_rgb_QQVGA", bufferRX) == 0) // Set up for 160*120 pixels RGB565
edodm85 0:2208b72b1ba1 145 {
edodm85 0:2208b72b1ba1 146 format = 'r';
edodm85 0:2208b72b1ba1 147 resolution = QQVGA;
edodm85 0:2208b72b1ba1 148 if(camera.Init('r', QQVGA) != 1)
edodm85 0:2208b72b1ba1 149 {
edodm85 0:2208b72b1ba1 150 printf("Init Fail\r\n");
edodm85 0:2208b72b1ba1 151 }
edodm85 0:2208b72b1ba1 152 memset(bufferRX, 0, sizeof(bufferRX));
edodm85 0:2208b72b1ba1 153 }else
edodm85 0:2208b72b1ba1 154 if(strcmp("init_bw_QQVGA", bufferRX) == 0) // Set up for 160*120 pixels YUV (Only Y)
edodm85 0:2208b72b1ba1 155 {
edodm85 0:2208b72b1ba1 156 format = 'b';
edodm85 0:2208b72b1ba1 157 resolution = QQVGA;
edodm85 0:2208b72b1ba1 158 if(camera.Init('b', QQVGA) != 1)
edodm85 0:2208b72b1ba1 159 {
edodm85 0:2208b72b1ba1 160 printf("Init Fail\r\n");
edodm85 0:2208b72b1ba1 161 }
edodm85 0:2208b72b1ba1 162 memset(bufferRX, 0, sizeof(bufferRX));
edodm85 0:2208b72b1ba1 163 }else
edodm85 0:2208b72b1ba1 164 if(strcmp("reset", bufferRX) == 0)
edodm85 0:2208b72b1ba1 165 {
edodm85 0:2208b72b1ba1 166 mbed_reset();
edodm85 0:2208b72b1ba1 167 }else
edodm85 0:2208b72b1ba1 168 if(strcmp("time", bufferRX) == 0)
edodm85 0:2208b72b1ba1 169 {
edodm85 0:2208b72b1ba1 170 sprintf(bufferTX, "Tot time acq + send (mbed): %dms\r\n", t2-t1);
edodm85 0:2208b72b1ba1 171 client.send_all(bufferTX, sizeof(bufferTX));
edodm85 0:2208b72b1ba1 172 memset(bufferTX, 0, sizeof(bufferTX));
edodm85 0:2208b72b1ba1 173 }
edodm85 0:2208b72b1ba1 174 memset(bufferRX, 0, sizeof(bufferRX));
edodm85 0:2208b72b1ba1 175 }
edodm85 0:2208b72b1ba1 176
edodm85 0:2208b72b1ba1 177
edodm85 0:2208b72b1ba1 178 void CameraSnap(){
edodm85 0:2208b72b1ba1 179 led4 = 1;
edodm85 0:2208b72b1ba1 180 t1 = t.read_ms();
edodm85 0:2208b72b1ba1 181
edodm85 0:2208b72b1ba1 182 // Kick things off by capturing an image
edodm85 0:2208b72b1ba1 183 camera.CaptureNext();
edodm85 0:2208b72b1ba1 184 while(camera.CaptureDone() == false);
edodm85 0:2208b72b1ba1 185 // Start reading in the image data from the camera hardware buffer
edodm85 0:2208b72b1ba1 186 camera.ReadStart();
edodm85 0:2208b72b1ba1 187
edodm85 0:2208b72b1ba1 188
edodm85 0:2208b72b1ba1 189 int p = 0;
edodm85 0:2208b72b1ba1 190 if(format == 'b') // B&W
edodm85 0:2208b72b1ba1 191 {
edodm85 0:2208b72b1ba1 192 for(int x = 0; x<resolution/9600; x++)
edodm85 0:2208b72b1ba1 193 {
edodm85 0:2208b72b1ba1 194 for(int q = 0; q<9600; q++)
edodm85 0:2208b72b1ba1 195 {
edodm85 0:2208b72b1ba1 196 // Read in the first half of the image
edodm85 0:2208b72b1ba1 197 if(resolution != VGA)
edodm85 0:2208b72b1ba1 198 camera.ReadOnebyte();
edodm85 0:2208b72b1ba1 199 // Read in the Second half of the image
edodm85 0:2208b72b1ba1 200 bufferTX[q] = camera.ReadOnebyte(); // Y only
edodm85 0:2208b72b1ba1 201 }
edodm85 0:2208b72b1ba1 202 Send();
edodm85 0:2208b72b1ba1 203 }
edodm85 0:2208b72b1ba1 204 }
edodm85 0:2208b72b1ba1 205
edodm85 0:2208b72b1ba1 206 if(format == 'y' || format == 'r') // Color
edodm85 0:2208b72b1ba1 207 {
edodm85 0:2208b72b1ba1 208 for(int x = 0; x<(resolution/9600)*2; x++)
edodm85 0:2208b72b1ba1 209 {
edodm85 0:2208b72b1ba1 210 for(int q = 0; q<9600/2; q++)
edodm85 0:2208b72b1ba1 211 {
edodm85 0:2208b72b1ba1 212 p = q*2;
edodm85 0:2208b72b1ba1 213 // Read in the first half of the image
edodm85 0:2208b72b1ba1 214 bufferTX[p] = camera.ReadOnebyte();
edodm85 0:2208b72b1ba1 215 // Read in the Second half of the image
edodm85 0:2208b72b1ba1 216 bufferTX[p+1] = camera.ReadOnebyte();
edodm85 0:2208b72b1ba1 217 }
edodm85 0:2208b72b1ba1 218 Send();
edodm85 0:2208b72b1ba1 219 }
edodm85 0:2208b72b1ba1 220 }
edodm85 0:2208b72b1ba1 221 camera.ReadStop();
edodm85 0:2208b72b1ba1 222 t2 = t.read_ms();
edodm85 0:2208b72b1ba1 223
edodm85 0:2208b72b1ba1 224 // Immediately request the next image to be captured (takes around 45ms)
edodm85 0:2208b72b1ba1 225 camera.CaptureNext();
edodm85 0:2208b72b1ba1 226 // Now wait for the image to finish being captured
edodm85 0:2208b72b1ba1 227 while (camera.CaptureDone() == false);
edodm85 0:2208b72b1ba1 228
edodm85 0:2208b72b1ba1 229 //pc.printf("Snap_done\r\n");
edodm85 0:2208b72b1ba1 230 led4 = 0;
edodm85 0:2208b72b1ba1 231 }