Diff: main.cpp

Revision:

3:3c7906d60f89

Parent:

1:31e50fea8be8

Child:

4:6ed9c8bb82c3

diff -r c69a06fe81c0 -r 3c7906d60f89 main.cpp
--- a/main.cpp	Fri Aug 24 14:06:31 2012 +0000
+++ b/main.cpp	Thu Dec 13 23:59:40 2012 +0000
@@ -1,28 +1,224 @@
 #include "mbed.h"
 #include "WiflyInterface.h"
-#include "Websocket.h"
+#include "NokiaLCD.h"
+#include "picojpeg.h"
+#include "DebounceIn.h"
+#include "GPS.h"
+#include <vector>
 
+#define DEFAULTZOOM 15
 
 /* wifly interface:
-*     - p9 and p10 are for the serial communication
-*     - p19 is for the reset pin
-*     - p26 is for the connection status
-*     - "mbed" is the ssid of the network
-*     - "password" is the password
+*     - p13 and p14 are for the serial communication
+*     - p28 is for the reset pin
+*     - p27 is for the connection status
+*     - 5th field is the ssid of the network
+*     - 6th field is the password
 *     - WPA is the security
 */
-WiflyInterface wifly(p9, p10, p19, p26, "mbed", "password", WPA);
+
+WiflyInterface wifly(p13, p14, p28, p27, "GTother", "GeorgeP@1927", WPA);
+Serial pc(USBTX,USBRX);
+LocalFileSystem local("local");// Create the local filesystem under the name "local"
+GPS gps(p9, p10);
+DebounceIn ZoomIn(p18);
+DebounceIn Refresh(p19);
+DebounceIn ZoomOut(p20);
+FILE *jpegfile;
+int jpeg_filesize = 0;
+int jpeg_filepos = 0;
+NokiaLCD lcd(p5, p7, p8, p11, NokiaLCD::LCD6610);
+int zoom = DEFAULTZOOM;
+
+
+unsigned char pjpeg_need_bytes_callback(unsigned char* pBuf, unsigned char buf_size, unsigned char *pBytes_actually_read, void *pCallback_data)
+{
+    unsigned int n = min((unsigned int)(jpeg_filesize - jpeg_filepos), (unsigned int)buf_size);
+    if (n && (fread(pBuf, 1, n, jpegfile) != n))
+        return PJPG_STREAM_READ_ERROR;
+    *pBytes_actually_read = (unsigned char)(n);
+    jpeg_filepos += n;
+    return 0;
+}
+
+void ReadJPEGFromFile(const char *filename, NokiaLCD *lcd)
+{
+    pjpeg_image_info_t imageInfo;
+    jpegfile = fopen(filename,"rb");
+    if(!jpegfile) {
+        pc.printf("File not Found: %s\n\r",filename);
+    }
+    fseek(jpegfile, 0, SEEK_END);
+    jpeg_filesize = ftell(jpegfile);
+    jpeg_filepos = 0;
+    fseek(jpegfile, 0, SEEK_SET);
+    int status = pjpeg_decode_init(&imageInfo, pjpeg_need_bytes_callback, NULL);
+    //const unsigned int row_pitch = imageInfo.m_width * imageInfo.m_comps;
+    int mcu_x = 0;
+    int mcu_y = 0;
+
+    for ( ; ; ) {
+        status = pjpeg_decode_mcu();
+
+        if (status) {
+            if (status != PJPG_NO_MORE_BLOCKS) {
+                //pc.printf("pjpeg_decode_mcu() failed with status %u\n", status);
+                fclose(jpegfile);
+                return;
+            }
 
-int main() {
-    wifly.init(); //Use DHCP
-    while (!wifly.connect());
-    printf("IP Address is %s\n\r", wifly.getIPAddress());
+            break;
+        }
+
+        if (mcu_y >= imageInfo.m_MCUSPerCol) {
+            fclose(jpegfile);
+            return;
+        }
+
+        // Copy MCU's pixel blocks into the destination bitmap.
+
+        for (int y = 0; y < imageInfo.m_MCUHeight; y += 8) {
+            const int by_limit = min(8, imageInfo.m_height - (mcu_y * imageInfo.m_MCUHeight + y));
+            for (int x = 0; x < imageInfo.m_MCUWidth; x += 8) {
+
+                unsigned int src_ofs = (x * 8U) + (y * 16U);
+                const unsigned char *pSrcR = imageInfo.m_pMCUBufR + src_ofs;
+                const unsigned char *pSrcG = imageInfo.m_pMCUBufG + src_ofs;
+                const unsigned char *pSrcB = imageInfo.m_pMCUBufB + src_ofs;
+
+                const int bx_limit = min(8, imageInfo.m_width - (mcu_x * imageInfo.m_MCUWidth + x));
+
+                if (imageInfo.m_scanType == PJPG_GRAYSCALE) {
+                    for (int by = 0; by < by_limit; by++) {
+                        for (int bx = 0; bx < bx_limit; bx++) {
+                            unsigned int color = ((*pSrcR++) << 16);
+                            (*lcd).pixel(mcu_x*imageInfo.m_MCUWidth+x+bx,mcu_y*imageInfo.m_MCUHeight+y+by,color);
+                        }
+                        pSrcR += (8 - bx_limit);
+                    }
+                } else {
+                    for (int by = 0; by < by_limit; by++) {
+                        for (int bx = 0; bx < bx_limit; bx++) {
+                            unsigned int color = ((*pSrcR++) << 16) | ((*pSrcG++) << 8) | (*pSrcB++);
+                            (*lcd).pixel((130-imageInfo.m_width)/2+mcu_x*imageInfo.m_MCUWidth+x+bx,(130-imageInfo.m_height)/2+mcu_y*imageInfo.m_MCUHeight+y+by,color);
+                        }
+
+                        pSrcR += (8 - bx_limit);
+                        pSrcG += (8 - bx_limit);
+                        pSrcB += (8 - bx_limit);
+
+                    }
+                }
+            }
+        }
+
+        mcu_x++;
+        if (mcu_x == imageInfo.m_MCUSPerRow) {
+            mcu_x = 0;
+            mcu_y++;
+        }
+    }
 
-    Websocket ws("ws://sockets.mbed.org:443/ws/demo/wo");
-    while (!ws.connect());
+    fclose(jpegfile);
+}
+
+void wiflyConnect()
+{
+    wifly.disconnect();
+    wifly.init();
+    while (!wifly.connect()) {
+        pc.printf("waiting\n\r");
+    }// join the network
+}
+
+void getNewImage(float latitude, float longitude, int zoom)
+{
+    TCPSocketConnection sock;
+    sock.connect("maps.googleapis.com", 80);
+    int ret = 0;
+    int total_bytes = 0;
+    char http_cmd[300];
+    sprintf(http_cmd, "GET /maps/api/staticmap?center=%f%%2C%f&zoom=%d&size=130x130&sensor=true&format=jpg-baseline HTTP/1.0\n\n",latitude,longitude,zoom);
+    sock.send_all(http_cmd, sizeof(http_cmd)-1);
 
-    while (1) {
-            ws.send("WebSocket Hello World over Wifly");
-            wait(1.0);
+    sock.set_blocking(false,10000);
+    char buffer[300];
+    FILE* pFile;
+    pc.printf("%s\n\r",http_cmd);
+    pFile = fopen ("/local/image.jpg","w");
+    pc.printf("Opening File\n\r");
+    bool found_start = false;
+    bool found_end = false;
+    while (true) {
+        ret = sock.receive(buffer, sizeof(buffer)-1);
+        if (ret <= 0) {
+            pc.printf("Ret < 0. Break. \n\r");
+            //wiflyConnect();
+            break;
+        }
+        buffer[ret] = '\0';
+        total_bytes += ret;
+        pc.printf("Received %d chars from server, total %d: %s\n\r", ret,total_bytes, buffer);
+        if(found_start) {
+            for(int i=1; i<ret; i++) {
+                if(buffer[i-1]==0xFF && buffer[i]==0xD9) { //jpg file end at FFD9
+                    pc.printf("found end. \n\r");
+                    fwrite(buffer,1,i+1,pFile);
+                    found_end = true;
+                    break;
+                }
+            }
+            if(!found_end)
+                fwrite(buffer,1,ret,pFile);
+            else {
+                pc.printf("Found Start and End. Break. \n\r");
+                break;
+            }
+
+        } else {
+            for(int i=1; i<ret; i++) {
+                if(buffer[i-1]==0xFF && buffer[i]==0xD8) { //jpg file starts from FFD8
+                    pc.printf("found start.\n\r");
+                    fwrite(&buffer[i-1],1,ret-i+1,pFile);
+                    found_start = true;
+                    break;
+                }
+            }
+        }
     }
+
+    fclose (pFile);
+    pc.printf("Closing File\n\r");
+    sock.close();
+    lcd.cls();
+    ReadJPEGFromFile("/local/IMAGE.JPG", &lcd);
+}
+
+int main()
+{
+    pc.printf("Hello\n\r");
+    wifly.init(); //Use DHCP
+    while (!wifly.connect()) {
+        pc.printf("waiting\n\r");
+    }// join the network
+    pc.printf("IP Address is %s\n", wifly.getIPAddress());
+
+    float longitude = 0.0;
+    float latitude = 0.0;
+    while(1) {
+        if(gps.sample()) {
+           // pc.printf("I'm at %f, %f\n", gps.longitude, gps.latitude);
+            longitude = gps.longitude;
+            latitude = gps.latitude;
+        } else {
+            pc.printf("Oh Dear! No lock :(\n");
+        }
+        if(Refresh)
+            getNewImage(latitude,longitude,zoom);
+        else if(ZoomIn)
+            getNewImage(latitude,longitude,++zoom);
+        else if(ZoomOut)
+            getNewImage(latitude,longitude,--zoom);
+    }
+    wifly.disconnect();
 }
\ No newline at end of file