Changeset 5975:d856dad45320 in roaraudio for libroarlight/roardmx.c

Timestamp:

01/27/14 16:22:27 (10 years ago)

Author:

phi

Branch:

default

Phase:

public

Message:

Added support for rangeset to libroarlight.

File:

• libroarlight/roardmx.c (modified) (1 diff)

libroarlight/roardmx.c

@@ -427 +427 @@
 // Not yet supported.
 // * RANGESET:
-// Not yet supported.
+int roar_roardmx_message_new_rangeset(struct roar_roardmx_message * mes) {
+ BCHK(mes);
+
+ if ( roar_roardmx_message_new(mes) == -1 )
+  return -1;
+
+ mes->type = ROAR_ROARDMX_TYPE_SSET;
+
+ return 0;
+}
+
+int roar_roardmx_message_add_rangeval(struct roar_roardmx_message * mes, uint16_t   start, uint16_t   end, unsigned char   val) {
+ register uint8_t * p;
+
+ BCHK(mes);
+
+ if ( mes->type != ROAR_ROARDMX_TYPE_RANGESET ) {
+  roar_err_set(ROAR_ERROR_TYPEMM);
+  return -1;
+ }
+
+ if ( (mes->length + 5) > ROAR_ROARDMX_DATA_LENGTH ) { // message would be to long
+  roar_err_set(ROAR_ERROR_NOSPC);
+  return -1;
+ }
+
+ p = mes->data + 3 + mes->length;
+
+ p[0] = (start & 0xFF00) >> 8;
+ p[1] = (start & 0x00FF);
+ p[2] = (end   & 0xFF00) >> 8;
+ p[3] = (end   & 0x00FF);
+ p[4] = val;
+
+ mes->length += 5;
+
+ return 0;
+}
+
+int roar_roardmx_message_get_rangeval(struct roar_roardmx_message * mes, uint16_t * start, uint16_t * end, unsigned char * val, int index) {
+ register uint8_t * p;
+ register uint16_t v;
+
+ BCHK(mes);
+
+ if ( index < 0 ) {
+  roar_err_set(ROAR_ERROR_INVAL);
+  return -1;
+ }
+
+ if ( mes->version != ROAR_ROARDMX_VERSION ) {
+  roar_err_set(ROAR_ERROR_NSVERSION);
+  return -1;
+ }
+
+ if ( mes->type != ROAR_ROARDMX_TYPE_RANGESET ) {
+  roar_err_set(ROAR_ERROR_TYPEMM);
+  return -1;
+ }
+
+ if ( (((size_t)index + 1) * 5) > (mes->length - 3) ) {
+  roar_err_set(ROAR_ERROR_NOENT);
+  return -1;
+ }
+
+ p = mes->data + 3 + index * 5; 
+
+ v   = *(p++);
+ v <<= 8;
+ v  += *(p++);
+ *start = v;
+
+ v   = *(p++);
+ v <<= 8;
+ v  += *(p++);
+ *end = v;
+
+ *val = *p;
+
+ return 0;
+}
+
 // * EVENT:
 int roar_roardmx_message_new_event(struct roar_roardmx_message * mes) {