more input system stuff

1 files changed, 15 insertions, 0 deletions

diff --git a/libopie2/opiecore/oinputsystem.cpp b/libopie2/opiecore/oinputsystem.cpp
index bfdc31f..fde36c3 100644
--- a/libopie2/opiecore/oinputsystem.cpp
+++ b/libopie2/opiecore/oinputsystem.cpp
@@ -31,24 +31,29 @@ using namespace Opie::Core;
 
 /* QT */
 #include <qfile.h>
 
 /* STD */
 #include <errno.h>
 #include <string.h>
 #include <linux/input.h>
 #include <sys/fcntl.h>
 #include <sys/ioctl.h>
 
 #define BUFSIZE 256
+#define     BIT_MASK( name, numbits )                                        \
+    unsigned short  name[ ((numbits) - 1) / (sizeof( short ) * 8) + 1 ];    \
+    memset( name, 0, sizeof( name ) )
+#define     BIT_TEST( bitmask, bit )    \
+    ( bitmask[ (bit) / sizeof(short) / 8 ] & (1u << ( (bit) % (sizeof(short) * 8))) )
 
 /*======================================================================================
  * OInputSystem
  *======================================================================================*/
 
 OInputSystem* OInputSystem::_instance = 0;
 
 OInputSystem::OInputSystem() : QObject()
 {
     qDebug( "OInputSystem::OInputSystem()" );
     synchronize();
 }
@@ -131,12 +136,22 @@ QString OInputDevice::path() const
     ::ioctl( _fd, EVIOCGPHYS(sizeof buf), buf );
     return buf;
 }
 
 
 QString OInputDevice::uniq() const
 {
     char buf[BUFSIZE] = "<unknown>";
     ::ioctl( _fd, EVIOCGUNIQ(sizeof buf), buf );
     return buf;
 }
 
+bool OInputDevice::hasFeature( Feature bit ) const
+{
+    BIT_MASK( features, EV_MAX );
+            
+    if( ioctl( _fd, EVIOCGBIT( 0, EV_MAX ), features) < 0 )
+        return false;
+    else
+        return BIT_TEST( features, bit );
+}
+