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@1:0e4d23df43ea, 2013-07-20 (annotated)

Committer:
edodm85
Date:
Sat Jul 20 16:36:31 2013 +0000
Revision:
1:0e4d23df43ea
Parent:
0:2208b72b1ba1
Child:
2:d6b38a4512eb
updated "for" condition

Who changed what in which revision?

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