4 files changed, 136 insertions, 2 deletions

diff --git a/src/ecbor.c b/src/ecbor.c
index 2a9b5fb..0a5e3fb 100644
--- a/src/ecbor.c
+++ b/src/ecbor.c
@@ -58,14 +58,40 @@ ecbor_uint64_from_big_endian (uint64_t value)
 #endif
 }
 
+extern float
+ecbor_fp32_from_big_endian (float value)
+{
+#if __BYTE_ORDER__ && (__BYTE_ORDER__ == __ORDER_BIG_ENDIAN__)
+  return value;
+#elif __BYTE_ORDER__ && (__BYTE_ORDER__ == __ORDER_LITTLE_ENDIAN__)
+  uint32_t r = ecbor_uint32_from_big_endian(*((uint32_t *) &value));
+  return *((float *) &r);
+#else
+  #error "Endianness not supported!"
+#endif
+}
+
+extern double
+ecbor_fp64_from_big_endian (double value)
+{
+#if __BYTE_ORDER__ && (__BYTE_ORDER__ == __ORDER_BIG_ENDIAN__)
+  return value;
+#elif __BYTE_ORDER__ && (__BYTE_ORDER__ == __ORDER_LITTLE_ENDIAN__)
+  uint64_t r = ecbor_uint64_from_big_endian(*((uint64_t *) &value));
+  return *((double *) &r);
+#else
+  #error "Endianness not supported!"
+#endif
+}
+
 extern ecbor_major_type_t
 ecbor_get_type (ecbor_item_t *item)
 {
   if (!item) {
     return ECBOR_MT_UNDEFINED;
   }
-  if (item->major_type < ECBOR_MT_UINT
-      || item->major_type > ECBOR_MT_SPECIAL) {
+  if (item->major_type < ECBOR_MT_FIRST
+      || item->major_type > ECBOR_MT_LAST) {
     return ECBOR_MT_UNDEFINED;
   }
   return item->major_type;
@@ -101,6 +127,17 @@ ecbor_get_value (ecbor_item_t *item, void *value)
     case ECBOR_MT_TAG:
       *((uint64_t *)value) = item->value.tag.tag_value;
       break;
+    
+    case ECBOR_MT_FP16:
+      return ECBOR_ERR_CURRENTLY_NOT_SUPPORTED;
+
+    case ECBOR_MT_FP32:
+      *((float *)value) = item->value.fp32;
+      break;
+
+    case ECBOR_MT_FP64:
+      *((double *)value) = item->value.fp64;
+      break;
 
     default:
       return ECBOR_ERR_INVALID_TYPE;
diff --git a/src/ecbor_decoder.c b/src/ecbor_decoder.c
index 66d4426..1c065d8 100644
--- a/src/ecbor_decoder.c
+++ b/src/ecbor_decoder.c
@@ -145,6 +145,56 @@ ecbor_decode_uint (ecbor_decode_context_t *context,
   return ECBOR_OK;
 }
 
+static inline ecbor_error_t
+ecbor_decode_fp32 (ecbor_decode_context_t *context,
+                   float *value,
+                   uint64_t *size)
+{
+  /* compute storage size */
+  (*size) = sizeof (float);
+  if (context->bytes_left < (*size)) {
+    return ECBOR_ERR_INVALID_END_OF_BUFFER;
+  }
+
+  /* read actual value */
+  (*value) =
+    ecbor_fp32_from_big_endian (*((float *) context->in_position));
+  
+  /* advance buffer */
+  context->in_position += (*size);
+  context->bytes_left -= (*size);
+  
+  /* meter the first byte */
+  (*size) ++;
+  
+  return ECBOR_OK;
+}
+
+static inline ecbor_error_t
+ecbor_decode_fp64 (ecbor_decode_context_t *context,
+                   double *value,
+                   uint64_t *size)
+{
+  /* compute storage size */
+  (*size) = sizeof (double);
+  if (context->bytes_left < (*size)) {
+    return ECBOR_ERR_INVALID_END_OF_BUFFER;
+  }
+
+  /* read actual value */
+  (*value) =
+    ecbor_fp64_from_big_endian (*((double *) context->in_position));
+
+  /* advance buffer */
+  context->in_position += (*size);
+  context->bytes_left -= (*size);
+  
+  /* meter the first byte */
+  (*size) ++;
+  
+  return ECBOR_OK;
+}
+
 static ecbor_error_t
 ecbor_decode_next_internal (ecbor_decode_context_t *context,
                             ecbor_item_t *item,
@@ -417,7 +467,22 @@ ecbor_decode_next_internal (ecbor_decode_context_t *context,
         /* stop code */
         item->size = 1;
         return ECBOR_END_OF_INDEFINITE;
+      } else if (additional <= ECBOR_ADDITIONAL_1BYTE) {
+        return ecbor_decode_uint (context, &item->value.uinteger, &item->size,
+                                  additional);
+      } else if (additional == ECBOR_ADDITIONAL_2BYTE) {
+        /* currently we do not support half float */
+        return ECBOR_ERR_CURRENTLY_NOT_SUPPORTED;
+      } else if (additional == ECBOR_ADDITIONAL_4BYTE) {
+        /* floating point 32bit */
+        item->major_type = ECBOR_MT_FP32;
+        return ecbor_decode_fp32 (context, &item->value.fp32, &item->size);
+      } else if (additional == ECBOR_ADDITIONAL_8BYTE) {
+        /* floating point 64bit */
+        item->major_type = ECBOR_MT_FP64;
+        return ecbor_decode_fp64 (context, &item->value.fp64, &item->size);
       } else {
+        /* currently unassigned according to RFC */
         return ECBOR_ERR_CURRENTLY_NOT_SUPPORTED;
       }
       break;
diff --git a/src/ecbor_describe.c b/src/ecbor_describe.c
index bf1337b..1cd9917 100644
--- a/src/ecbor_describe.c
+++ b/src/ecbor_describe.c
@@ -221,6 +221,32 @@ print_ecbor_item (ecbor_item_t *item, unsigned int level, char *prefix)
       }
       break;
 
+    case ECBOR_MT_FP32:
+      {
+        float val;
+        
+        rc = ecbor_get_value (item, (void *) &val);
+        if (rc != ECBOR_OK) {
+          return rc;
+        }
+        
+        printf ("[FP32] value %f\n", val);
+      }
+      break;
+
+    case ECBOR_MT_FP64:
+      {
+        double val;
+        
+        rc = ecbor_get_value (item, (void *) &val);
+        if (rc != ECBOR_OK) {
+          return rc;
+        }
+        
+        printf ("[FP64] value %f\n", val);
+      }
+      break;
+
     default:
       printf ("[UNKNOWN]\n");
       break;
diff --git a/src/ecbor_internal.h b/src/ecbor_internal.h
index b783eb1..e5e4179 100644
--- a/src/ecbor_internal.h
+++ b/src/ecbor_internal.h
@@ -37,4 +37,10 @@ ecbor_uint32_from_big_endian (uint32_t value);
 extern uint64_t
 ecbor_uint64_from_big_endian (uint64_t value);
 
+extern float
+ecbor_fp32_from_big_endian (float value);
+
+extern double
+ecbor_fp64_from_big_endian (double value);
+
 #endif
\ No newline at end of file