From e814a233ed93402b07f3ea5d1f55ec1af08fbb76 Mon Sep 17 00:00:00 2001
From: Sebastian Huber <sebastian.huber@embedded-brains.de>
Date: Fri, 16 Sep 2016 14:20:07 +0200
Subject: termios: Add IO control handler

Update #2785.
---
 cpukit/libcsupport/include/rtems/termiostypes.h | 15 +++++++++++++++
 cpukit/libcsupport/src/termios.c                |  7 +++++--
 2 files changed, 20 insertions(+), 2 deletions(-)

diff --git a/cpukit/libcsupport/include/rtems/termiostypes.h b/cpukit/libcsupport/include/rtems/termiostypes.h
index 80251a22d2..a852c1dbed 100644
--- a/cpukit/libcsupport/include/rtems/termiostypes.h
+++ b/cpukit/libcsupport/include/rtems/termiostypes.h
@@ -183,6 +183,21 @@ typedef struct {
     const struct termios         *term
   );
 
+  /**
+   * @brief IO control handler.
+   *
+   * Invoked in case the Termios layer cannot deal with the IO request.
+   *
+   * @param[in] context The Termios device context.
+   * @param[in] request The IO control request.
+   * @param[in] buffer The IO control buffer.
+   */
+  int (*ioctl)(
+    rtems_termios_device_context *context,
+    ioctl_command_t               request,
+    void                         *buffer
+  );
+
   /**
    * @brief Termios device mode.
    */
diff --git a/cpukit/libcsupport/src/termios.c b/cpukit/libcsupport/src/termios.c
index 3a6a3897f4..b972b4f34f 100644
--- a/cpukit/libcsupport/src/termios.c
+++ b/cpukit/libcsupport/src/termios.c
@@ -781,8 +781,11 @@ rtems_termios_ioctl (void *arg)
   default:
     if (rtems_termios_linesw[tty->t_line].l_ioctl != NULL) {
       sc = rtems_termios_linesw[tty->t_line].l_ioctl(tty,args);
-    }
-    else {
+    } else if (tty->handler.ioctl) {
+      args->ioctl_return = (*tty->handler.ioctl) (tty->device_context,
+        args->command, args->buffer);
+      sc = RTEMS_SUCCESSFUL;
+    } else {
       sc = RTEMS_INVALID_NUMBER;
     }
     break;
-- 
cgit v1.2.3