Changeset 5904:768618299b76 in roaraudio

Timestamp:

04/21/13 02:02:41 (11 years ago)

Author:

phi

Branch:

default

Phase:

public

Message:

added write support to special bar port

File:

• plugins/universal/piface.c (modified) (2 diffs)

plugins/universal/piface.c

@@ -170 +170 @@
 }
 
+static inline unsigned char __render_bar(int bits) {
+ unsigned char ret = 0;
+ int i;
+
+ // this is a generic version. As long as this is not called too often it should work fine.
+
+ for (i = 0; i < bits; i++) {
+  ret <<= 1;
+  ret  |= 1;
+ }
+
+ return ret;
+}
+
  // get list of gpio IDs.
  // buffer is passed as ids, buffer size (in elements) is passed as len.
@@ -308 +322 @@
  port = &(state->ports[id]);
 
- if ( !(port->mode & ROAR_SERVICE_GPIO_FOUTPUT) || port->type != ROAR_SERVICE_GPIO_TBOOL ) {
+ if ( !(port->mode & ROAR_SERVICE_GPIO_FOUTPUT) ) {
   roar_err_set(ROAR_ERROR_NOTSUP);
   return -1;
  }
 
- bit = 1 << (id & 0x07);
-
- buffer = state->buffer_output;
- buffer |= bit;
-
- if ( !val )
-  buffer -= bit;
-
- piface__write_output(buffer);
-
- return 0;
+ if ( val < port->irange_min || val > port->irange_max ) {
+  roar_err_set(ROAR_ERROR_RANGE);
+  return -1;
+ }
+
+ switch (port->type) {
+  case ROAR_SERVICE_GPIO_TBOOL:
+    bit = 1 << (id & 0x07);
+
+    buffer = state->buffer_output;
+    buffer |= bit;
+
+    if ( !val )
+     buffer -= bit;
+
+    piface__write_output(buffer);
+
+    return 0;
+   break;
+  case ROAR_SERVICE_GPIO_TINT:
+    piface__write_output(__render_bar(val));
+    return 0;
+   break;
+  default:
+    roar_err_set(ROAR_ERROR_NOTSUP);
+    return -1;
+   break;
+ }
 }