sys/io: Cleanup main.c

diff --git a/sys/io/main.c b/sys/io/main.c
index 07cd1bc8a07ee0162c78527816aeec15e45d4947..c0be2d8c823df1a2cd98ca50b8b29ebea1ab972f 100644 (file)
--- a/sys/io/main.c
+++ b/sys/io/main.c
@@ -5,12 +5,36 @@
 #include <errno.h>
 #include <string.h>
 
-/*
-int cxio_read(struct cxmsg*);
-int cxio_write(struct cxmsg*);
-int cxio_open(struct cxmsg*);
-int cxio_close(struct cxmsg*);
-*/
+static int _handle_msg(struct cxmsg *msg)
+{
+       int ret_val;
+       char str[128];
+       int len;
+
+       switch(msg->cm_type) {
+       case CXIO_READ:
+       case CXIO_WRITE:
+       case CXIO_OPEN:
+       case CXIO_CLOSE:
+       default:
+               memset(str, 0, sizeof(str));
+               len = snprintf(str, sizeof(str), "Unhandled message TYPE=0x%x SRC=%u\n",
+                              msg->cm_type, msg->cm_src);
+               debug(str, len);
+
+               ret_val = -ENOSYS;
+               break;
+
+       case CXIO_PIPE:
+               memset(str, 0, sizeof(str));
+               len = snprintf(str, sizeof(str), "CXIO_PIPE from %u\n", msg->cm_src);
+               debug(str, len);
+               ret_val = -ENOSYS;
+               break;
+       }
+
+       return(ret_val);
+}
 
 int main(int argc, char *argv[])
 {
@@ -33,36 +57,7 @@ int main(int argc, char *argv[])
                        continue;
                }
 
-               switch(msg.cm_type) {
-#if 0
-               case CXIO_READ:
-                       err = cxio_read(&msg);
-                       break;
-
-               case CXIO_WRITE:
-                       err = cxio_write(&msg);
-                       break;
-
-               case CXIO_OPEN:
-                       err = cxio_open(&msg);
-                       break;
-
-               case CXIO_CLOSE:
-                       err = cxio_close(&msg);
-                       break;
-#endif /* 0 */
-               case CXIO_PIPE:
-                       memset(str, 0, sizeof(str));
-                       len = snprintf(str, sizeof(str), "CXIO_PIPE from 0x%x.\n", msg.cm_src);
-                       debug(str, len);
-                       break;
-
-               default:
-                       memset(str, 0, sizeof(str));
-                       len = snprintf(str, sizeof(str), "0x%x from 0x%x.\n", msg.cm_type, msg.cm_src);
-                       debug(str, len);
-                       break;
-               }
+               _handle_msg(&msg);
        }
 
        return(0);