Diff: Image.cpp

Revision:

0:b567d56a59d7

--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/Image.cpp	Fri Oct 03 13:30:09 2014 +0000
@@ -0,0 +1,96 @@
+
+#include "mbed.h"
+#include "Image.h"
+
+#include "bmp.h"
+#include "lodepng.h"
+
+int Image::decode(const unsigned char* pDataIn, unsigned int sizeIn, ImageData_t* pDataOut)
+{
+  Image::Type type = imageType(pDataIn, sizeIn);
+  int result = -1;
+  switch (type)
+  {
+    case BMP:
+    {
+      struct BMPHeader* hdr = (struct BMPHeader *) pDataIn;
+      pDataOut->pixels = (uint16_t*)malloc(hdr->width * hdr->height * 2);
+      if (pDataOut->pixels != NULL)
+      {
+        unsigned char error = BMP_Decode((void*)pDataIn, (unsigned char*)pDataOut->pixels, hdr->width, hdr->height, 24);
+        if (error == 0)
+        {
+          pDataOut->width = hdr->width;
+          pDataOut->height = hdr->height;
+          return 0;
+        }
+        free(pDataOut->pixels);
+      }
+    }
+    break;
+      
+    case PNG:
+    {
+      unsigned char* pTmp;
+      unsigned error = lodepng_decode24(&pTmp, &pDataOut->width, &pDataOut->height, pDataIn, sizeIn);
+      if (error == 0)
+      {
+        int x, y;
+        uint16_t* pConverted;
+        uint8_t r;
+        uint8_t g;
+        uint8_t b;
+        int off = 0;
+    
+        pDataOut->pixels = (uint16_t*)malloc(pDataOut->width * pDataOut->height * 2);
+        if (pDataOut->pixels != NULL)
+        {
+            pConverted = pDataOut->pixels;
+        
+            for (y = 0; y < pDataOut->height; y++) {
+              for (x = 0; x < pDataOut->width; x++) {
+                r = pTmp[off    ];
+                g = pTmp[off + 1];
+                b = pTmp[off + 2];
+                *pConverted = (((unsigned short)r & 0xF8) << 8) |
+                               (((unsigned short)g & 0xFC) << 3) |
+                               (((unsigned short)b & 0xF8) >> 3);
+                pConverted++;
+                off += 3;
+              }
+            }
+        }
+        free(pTmp);
+        return 0;
+      }
+    }
+    break;
+    
+    default:
+      break;
+  }
+  
+  pDataOut->pixels = NULL;
+  pDataOut->width = 0;
+  pDataOut->height = 0;
+  return result;
+}
+
+Image::Type Image::imageType(const unsigned char* pDataIn, unsigned int sizeIn)
+{
+  if (sizeIn > 4)
+  {
+    if (pDataIn[0] == 0x89 && pDataIn[1] == 'P' && pDataIn[2] == 'N' && pDataIn[3] == 'G')
+    {
+      return PNG;
+    }
+  }
+  if (BMP_IsValid((void*)pDataIn))
+  {
+    return BMP;
+  }
+  return UNKNOWN;
+}
+
+
+