fadi ladhari
/
GPS_System_with_Google_Maps
hello_world
Fork of GPS_System_with_Google_Maps by
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