Added new functionality to libopie / ODevice, regarding LCD control (on/off

brightness)

2 files changed, 148 insertions, 20 deletions

diff --git a/libopie/odevice.cpp b/libopie/odevice.cpp
index 95fd6bd..6e3f114 100644
--- a/libopie/odevice.cpp
+++ b/libopie/odevice.cpp
@@ -3,201 +3,255 @@
 
     This library is free software; you can redistribute it and/or
     modify it under the terms of the GNU Library General Public
     License as published by the Free Software Foundation; either
     version 2 of the License, or (at your option) any later version.
 
     This library is distributed in the hope that it will be useful,
     but WITHOUT ANY WARRANTY; without even the implied warranty of
     MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
     Library General Public License for more details.
 
     You should have received a copy of the GNU Library General Public License
     along with this library; see the file COPYING.LIB.  If not, write to
     the Free Software Foundation, Inc., 59 Temple Place - Suite 330,
     Boston, MA 02111-1307, USA.
 */
 
 #include <stdlib.h>
 #include <unistd.h>
 #include <fcntl.h>
 #include <sys/ioctl.h>
 #include <signal.h>
 #include <sys/time.h>
 #include <linux/soundcard.h>
+#include <math.h>
 
 #include <qapplication.h>
 
 #include <qfile.h>
 #include <qtextstream.h>
 #include <qpe/sound.h>
 #include <qpe/resource.h>
 #include <qpe/config.h>
 
+#include "odevice.h"
 
+// _IO and friends are only defined in kernel headers ...
 
-#include "odevice.h"
+#define OD_IO(type,area,number,args)    (( type << 30 ) | ( area << 8 ) | ( number ) | ( sizeof( args ) << 16 ))
+#define OD_IOW(area,number,args)        OD_IO(1,area,number,args)
+#define OD_IOR(area,number,args)        OD_IO(2,area,number,args)
+#define OD_IORW(area,number,args)       OD_IO(3,area,number,args)
 
 
 class ODeviceData {
 public:
         QString m_vendorstr;
         OVendor m_vendor;
         
         QString m_modelstr;
         OModel m_model;
 
         QString m_systemstr;
         OSystem m_system;
         
         QString m_sysverstr;
         
         OLedState m_leds [4]; // just for convenience ...
 };
 
 class ODeviceIPAQ : public ODevice {
 protected: 
         virtual void init ( );
         
 public:
         virtual bool setPowerButtonHandler ( PowerButtonHandler h );
 
+        virtual bool setDisplayBrightness ( int b );
+        virtual int displayBrightnessResolution ( ) const;
+
         virtual void alarmSound ( );
 
         virtual uint hasLeds ( ) const;
         virtual OLedState led ( uint which ) const;
                 virtual bool setLed ( uint which, OLedState st );
 };
 
 class ODeviceZaurus : public ODevice {
 protected:
         virtual void init ( );
 
         public:
         virtual bool setPowerButtonHandler ( PowerButtonHandler h );
 
+        virtual bool setDisplayBrightness ( int b );
+        virtual int displayBrightnessResolution ( ) const;
+
         virtual void alarmSound ( );
         virtual void keySound ( );
                 virtual void touchSound ( );
 
         virtual uint hasLeds ( ) const;
         virtual OLedState led ( uint which ) const;
                 virtual bool setLed ( uint which, OLedState st );
         
 protected:
         virtual void buzzer ( int snd );
 };
 
 
 
 
 ODevice *ODevice::inst ( )
 {
         static ODevice *dev = 0;
         
         if ( !dev ) {
                 if ( QFile::exists ( "/proc/hal/model" ))
                         dev = new ODeviceIPAQ ( );
                 else if ( QFile::exists ( "/dev/sharp_buz" ) || QFile::exists ( "/dev/sharp_led" ))
                         dev = new ODeviceZaurus ( );
                 else
                         dev = new ODevice ( );
                         
                 dev-> init ( );
         }
         return dev;
 }
 
+
+/**************************************************
+ *
+ * common
+ *
+ **************************************************/
+
+
 ODevice::ODevice ( )
 {
         d = new ODeviceData;
 
         d-> m_modelstr = "Unknown";
         d-> m_model = OMODEL_Unknown;
         d-> m_vendorstr = "Unkown";
         d-> m_vendor = OVENDOR_Unknown;
         d-> m_systemstr = "Unkown";
         d-> m_system = OSYSTEM_Unknown;
         d-> m_sysverstr = "0.0";
 }
 
 void ODevice::init ( )
 {
 }
 
 ODevice::~ODevice ( )
 {
         delete d;
 }
 
-//#include <linux/apm_bios.h>
-
-//#define APM_IOC_SUSPEND        _IO('A',2)
-
-#define APM_IOC_SUSPEND          (( 0<<30 ) | ( 'A'<<8 ) | ( 2 ) | ( 0<<16 ))
-
 bool ODevice::setPowerButtonHandler ( ODevice::PowerButtonHandler )
 {
         return false;
 }
 
+//#include <linux/apm_bios.h>
+
+#define APM_IOC_SUSPEND          OD_IO( 0, 'A', 2, 0 )
+
+
 bool ODevice::suspend ( )
 {
         if ( d-> m_model == OMODEL_Unknown ) // better don't suspend in qvfb / on unkown devices
                 return false;
 
         int fd;
         bool res = false;
         
         if ((( fd = ::open ( "/dev/apm_bios", O_RDWR )) >= 0 ) ||
                     (( fd = ::open ( "/dev/misc/apm_bios",O_RDWR )) >= 0 )) {
                 struct timeval tvs, tvn;
 
                         ::signal ( SIGTSTP, SIG_IGN );// we don't want to be stopped
                 ::gettimeofday ( &tvs, 0 );
         
                 ::sync ( ); // flush fs caches
         
                 res = ( ::ioctl ( fd, APM_IOC_SUSPEND, 0 ) == 0 ); // tell the kernel to "start" suspending
 
                         if ( res ) {
                         ::kill ( -::getpid ( ), SIGTSTP ); // stop everthing in our process group
 
                         do { // wait at most 1.5 sec: either suspend didn't work or the device resumed
                                 ::usleep ( 200 * 1000 );
                                         ::gettimeofday ( &tvn, 0 );                     
                         } while ((( tvn. tv_sec - tvs. tv_sec ) * 1000 + ( tvn. tv_usec - tvs. tv_usec ) / 1000 ) < 1500 );
                         
                         ::kill ( -::getpid ( ), SIGCONT ); // continue everything in our process group
                         }
                 
                         ::close ( fd );         
                 ::signal ( SIGTSTP, SIG_DFL );
         }
         
         return res;
 }
 
+//#include <linux/fb.h> better not rely on kernel headers in userspace ...
+
+#define FBIOBLANK             OD_IO( 0, 'F', 0x11, 0 ) // 0x4611
+
+/* VESA Blanking Levels */
+#define VESA_NO_BLANKING      0
+#define VESA_VSYNC_SUSPEND    1
+#define VESA_HSYNC_SUSPEND    2
+#define VESA_POWERDOWN        3
+
+
+bool ODevice::setDisplayStatus ( bool on )
+{
+        if ( d-> m_model == OMODEL_Unknown )
+                return false;
+
+        bool res = false;
+        int fd;
+        
+        if (( fd = ::open ( "/dev/fb0", O_RDWR )) >= 0 ) {
+                res = ( ::ioctl ( fd, FBIOBLANK, on ? VESA_NO_BLANKING : VESA_POWERDOWN ) == 0 );
+                ::close ( fd );
+                }                                                                                       
+        return res;
+}
+
+bool ODevice::setDisplayBrightness ( int )
+{
+        return false;
+}
+
+int ODevice::displayBrightnessResolution ( ) const
+{
+        return 16;
+}
 
 QString ODevice::vendorString ( )
 {
         return d-> m_vendorstr;
 }
 
 OVendor ODevice::vendor ( )
 {
         return d-> m_vendor;
 }
 
 QString ODevice::modelString ( )
 {
         return d-> m_modelstr;
 }
 
 OModel ODevice::model ( )
 {
         return d-> m_model;
 }
 
 QString ODevice::systemString ( )
 {
         return d-> m_systemstr;
@@ -222,131 +276,136 @@ void ODevice::alarmSound ( )
         if ( snd. isFinished ( ))
                 snd. play ( );
 #endif
 #endif
 }
 
 void ODevice::keySound ( )
 {
 #ifndef QT_QWS_EBX
 #ifndef QT_NO_SOUND
         static Sound snd ( "keysound" );
 
         if ( snd. isFinished ( ))
                 snd. play ( );
 #endif
 #endif
 }
 
 void ODevice::touchSound ( )
 {
 
 #ifndef QT_QWS_EBX
 #ifndef QT_NO_SOUND
         static Sound snd ( "touchsound" );
-//qDebug("touchSound");
-        if ( snd. isFinished ( )) {
+
+        if ( snd. isFinished ( ))
                 snd. play ( );
-        //      qDebug("sound should play");
-                }
 #endif
 #endif
 }
 
 uint ODevice::hasLeds ( ) const
 {
         return 0;
 }
 
 OLedState ODevice::led ( uint /*which*/ ) const
 {
         return OLED_Off;
 }
 
 bool ODevice::setLed ( uint /*which*/, OLedState /*st*/ )
 {
         return false;
 }
 
 
 
 
-//#if defined( QT_QWS_IPAQ ) // IPAQ
-
+/**************************************************
+ *
+ * iPAQ
+ *
+ **************************************************/
 
 void ODeviceIPAQ::init ( )
 {
         d-> m_vendorstr = "HP";
         d-> m_vendor = OVENDOR_HP;
 
         QFile f ( "/proc/hal/model" );
 
         if ( f. open ( IO_ReadOnly )) {
                 QTextStream ts ( &f );
 
                 d-> m_modelstr = "H" + ts. readLine ( );
 
                 if ( d-> m_modelstr == "H3100" )
                         d-> m_model = OMODEL_iPAQ_H31xx;
                 else if ( d-> m_modelstr == "H3600" )
                         d-> m_model = OMODEL_iPAQ_H36xx;
                 else if ( d-> m_modelstr == "H3700" )
                         d-> m_model = OMODEL_iPAQ_H37xx;
                 else if ( d-> m_modelstr == "H3800" )
                         d-> m_model = OMODEL_iPAQ_H38xx;
                 else
                         d-> m_model = OMODEL_Unknown;
 
                 f. close ( );
         }
 
         f. setName ( "/etc/familiar-version" );
         if ( f. open ( IO_ReadOnly )) { 
                 d-> m_systemstr = "Familiar";
                 d-> m_system = OSYSTEM_Familiar;
                 
                 QTextStream ts ( &f );
                 d-> m_sysverstr = ts. readLine ( ). mid ( 10 );
                 
                 f. close ( );
         }
 
         d-> m_leds [0] = OLED_Off;
 }
 
 //#include <linux/h3600_ts.h>  // including kernel headers is evil ...
 
-typedef struct h3600_ts_led {
+typedef struct {
   unsigned char OffOnBlink;       /* 0=off 1=on 2=Blink */
   unsigned char TotalTime;        /* Units of 5 seconds */
   unsigned char OnTime;           /* units of 100m/s */
   unsigned char OffTime;          /* units of 100m/s */
 } LED_IN;
 
+typedef struct {
+        unsigned char mode;
+        unsigned char pwr;
+        unsigned char brightness;
+} FLITE_IN;
 
-// #define IOC_H3600_TS_MAGIC  'f'
-// #define LED_ON                  _IOW(IOC_H3600_TS_MAGIC,  5, struct h3600_ts_led)
-#define LED_ON    (( 1<<30 ) | ( 'f'<<8 ) | ( 5 ) | ( sizeof(struct h3600_ts_led)<<16 )) // _IOW only defined in kernel headers :(
+#define LED_ON    OD_IOW( 'f', 5, LED_IN )
+#define FLITE_ON  OD_IOW( 'f', 7, FLITE_IN )
 
 
 void ODeviceIPAQ::alarmSound ( )
 {
 #if defined( QT_QWS_IPAQ ) // IPAQ
 #ifndef QT_NO_SOUND
         static Sound snd ( "alarm" );
         int fd;
         int vol;
         bool vol_reset = false;
 
         if ((( fd = ::open ( "/dev/sound/mixer", O_RDWR )) >= 0 ) ||
             (( fd = ::open ( "/dev/mixer", O_RDWR )) >= 0 )) {
 
                 if ( ::ioctl ( fd, MIXER_READ( 0 ), &vol ) >= 0 ) {
                         Config cfg ( "qpe" );
                         cfg. setGroup ( "Volume" );
 
                         int volalarm = cfg. readNumEntry ( "AlarmPercent", 50 );
                         if ( volalarm < 0 )
                                 volalarm = 0;
                         else if ( volalarm > 100 )
                                 volalarm = 100;
                         volalarm |= ( volalarm << 8 );
@@ -369,92 +428,129 @@ void ODeviceIPAQ::alarmSound ( )
         }
 #endif
 #endif
 }
 
 uint ODeviceIPAQ::hasLeds ( ) const
 {
         return 1;
 }
 
 OLedState ODeviceIPAQ::led ( uint which ) const
 {
         if ( which == 0 )
                 return d-> m_leds [0];
         else
                 return OLED_Off;
 }
 
 bool ODeviceIPAQ::setLed ( uint which, OLedState st )
 {
         static int fd = ::open ( "/dev/touchscreen/0", O_RDWR|O_NONBLOCK );
 
         if ( which == 0 ) {
                 if ( fd >= 0 ) {
-                        struct h3600_ts_led leds;
+                        LED_IN leds;
                         ::memset ( &leds, 0, sizeof( leds ));
                         leds. TotalTime  = 0;
                         leds. OnTime     = 0;
                         leds. OffTime    = 1;
                         leds. OffOnBlink = 2;
 
                         switch ( st ) {
                                 case OLED_Off      : leds. OffOnBlink = 0; break;
                                 case OLED_On       : leds. OffOnBlink = 1; break;
                                 case OLED_BlinkSlow: leds. OnTime = 10; leds. OffTime = 10; break;
                                 case OLED_BlinkFast: leds. OnTime =  5; leds. OffTime =  5; break;
                         }
 
                         if ( ::ioctl ( fd, LED_ON, &leds ) >= 0 ) {
                                 d-> m_leds [0] = st;
                                 return true;
                         }
                 }
         }
         return false;
 }
 
 bool ODeviceIPAQ::setPowerButtonHandler ( ODevice::PowerButtonHandler p )
 {
         bool res = false;
         int fd;
         
         if (( fd = ::open ( "/proc/sys/ts/suspend_button_mode", O_WRONLY )) >= 0 ) {
                 if ( ::write ( fd, p == KERNEL ? "0" : "1", 1 ) == 1 )
                         res = true;
                 else
                         ::perror ( "write to /proc/sys/ts/suspend_button_mode" );
                 
                 ::close ( fd );
         }
         else
                 ::perror ( "/proc/sys/ts/suspend_button_mode" );
         
         return res;
 }
 
 
+bool ODeviceIPAQ::setDisplayBrightness ( int bright )
+{
+        bool res = false;
+        int fd;
+        
+        if ( bright > 255 )
+                bright = 255;
+        if ( bright < 0 )
+                bright = 0;
+
+        // 128 is the maximum if you want a decent lifetime for the LCD
+        
+        bright = (int) (( ::pow ( 2, double( bright ) / 255.0 ) - 1 ) * 128.0 ); // logarithmic
+        //bright = ( bright + 1 ) / 2;
+        
+        if ((( fd = ::open ( "/dev/ts", O_WRONLY )) >= 0 ) ||
+            (( fd = ::open ( "/dev/h3600_ts", O_WRONLY )) >= 0 )) {
+                FLITE_IN bl;
+                bl. mode = 1;
+                bl. pwr = bright ? 1 : 0;
+                bl. brightness = bright;
+                res = ( ::ioctl ( fd, FLITE_ON, &bl ) == 0 );
+                ::close ( fd );
+        }
+        return res;
+}
+
+int ODeviceIPAQ::displayBrightnessResolution ( ) const
+{
+        return 255; // really 128, but logarithmic control is smoother this way
+}
+
 
+/**************************************************
+ *
+ * Zaurus
+ *
+ **************************************************/
 
 
 
 void ODeviceZaurus::init ( )
 {
         d-> m_modelstr = "Zaurus SL5000";
         d-> m_model = OMODEL_Zaurus_SL5000;
         d-> m_vendorstr = "Sharp";
         d-> m_vendor = OVENDOR_Sharp;
 
         QFile f ( "/proc/filesystems" );
 
         if ( f. open ( IO_ReadOnly ) && ( QTextStream ( &f ). read ( ). find ( "\tjffs2\n" ) >= 0 )) {
                 d-> m_systemstr = "OpenZaurus";
                 d-> m_system = OSYSTEM_OpenZaurus;
 
                 f. close ( );
         }
         else {
                 d-> m_systemstr = "Zaurus";
                 d-> m_system = OSYSTEM_Zaurus;
         }
 
         d-> m_leds [0] = OLED_Off;
@@ -499,52 +595,53 @@ void ODeviceZaurus::init ( )
 //#define SHARP_PDA_APPQUIT         10  /* application ends */
 
 //#define SHARP_BUZ_SCHEDULE_ALARM  11  /* schedule alarm */
 //#define SHARP_BUZ_DAILY_ALARM     12  /* daily alarm */
 //#define SHARP_BUZ_GOT_PHONE_CALL  13  /* phone call sound */
 //#define SHARP_BUZ_GOT_MAIL        14  /* mail sound */
 //
 
         #defineSHARP_LED_IOCTL_START (SHARP_DEV_IOCTL_COMMAND_START)
 #define SHARP_LED_SETSTATUS   (SHARP_LED_IOCTL_START+1)
 
 typedef struct sharp_led_status {
   int which;   /* select which LED status is wanted. */
   int status;  /* set new led status if you call SHARP_LED_SETSTATUS */
 } sharp_led_status;
 
 #define SHARP_LED_MAIL_EXISTS  9       /* mail status (exists or not) */
 
 #define LED_MAIL_NO_UNREAD_MAIL  0   /* for SHARP_LED_MAIL_EXISTS */
 #define LED_MAIL_NEWMAIL_EXISTS  1   /* for SHARP_LED_MAIL_EXISTS */
 #define LED_MAIL_UNREAD_MAIL_EX  2   /* for SHARP_LED_MAIL_EXISTS */
 
 // #include <asm/sharp_apm.h> // including kernel headers is evil ...
 
-#define APM_IOCGEVTSRC          (( 2 ) | ( 'A'<<8 ) | ( 203 ) | ( sizeof(int) ))
-#define APM_IOCSEVTSRC          (( 3 ) | ( 'A'<<8 ) | ( 204 ) | ( sizeof(int) ))
+#define APM_IOCGEVTSRC          OD_IOR( 'A', 203, int )
+#define APM_IOCSEVTSRC          OD_IORW( 'A', 204, int )
 #define APM_EVT_POWER_BUTTON    (1 << 0)
 
+#define FL_IOCTL_STEP_CONTRAST    100
 
 
 void ODeviceZaurus::buzzer ( int sound )
 {
         static int fd = ::open ( "/dev/sharp_buz", O_RDWR|O_NONBLOCK );
   
         if ( fd >= 0 )
                 ::ioctl ( fd, SHARP_BUZZER_MAKESOUND, sound );
 }
 
 
 void ODeviceZaurus::alarmSound ( ) 
 {
         buzzer ( SHARP_BUZ_SCHEDULE_ALARM );
 }
 
 void ODeviceZaurus::touchSound ( ) 
 {
         buzzer ( SHARP_BUZ_TOUCHSOUND );
 }
 
 void ODeviceZaurus::keySound ( ) 
 {
         buzzer ( SHARP_BUZ_KEYSOUND );
@@ -600,24 +697,51 @@ bool ODeviceZaurus::setPowerButtonHandler ( ODevice::PowerButtonHandler p )
 
                 int sources = ::ioctl ( fd, APM_IOCGEVTSRC, 0 ); // get current event sources
 
                 if ( sources >= 0 ) {
                         if ( p == KERNEL )
                                 sources |= APM_EVT_POWER_BUTTON;
                         else 
                                 sources &= ~APM_EVT_POWER_BUTTON;
 
                         if ( ::ioctl ( fd, APM_IOCSEVTSRC, sources & ~APM_EVT_POWER_BUTTON ) >= 0 ) // set new event sources
                                 res = true;
                         else
                                 perror ( "APM_IOCGEVTSRC" );
                 }
                 else
                         perror ( "APM_IOCGEVTSRC" );
                 
                 ::close ( fd );
         }
         else
                 perror ( "/dev/apm_bios or /dev/misc/apm_bios" );
                 
     return res;
 }
+
+
+bool ODeviceZaurus::setDisplayBrightness ( int bright )
+{
+        bool res = false;
+        int fd;
+        
+        if ( bright > 255 )
+                bright = 255;
+        if ( bright < 0 )
+                bright = 0;
+        
+        if (( fd = ::open ( "/dev/fl", O_WRONLY )) >= 0 ) {
+                int bl = ( bright * 4 + 127 ) / 255; // only 4 steps on zaurus
+                if ( bright && !bl )
+                        bl = 1;
+                res = ( ::ioctl ( fd, FL_IOCTL_STEP_CONTRAST, bl ) == 0 );
+                ::close ( fd );
+        }
+        return res;
+}
+
+
+int ODeviceZaurus::displayBrightnessResolution ( ) const 
+{
+        return 4;
+}
diff --git a/libopie/odevice.h b/libopie/odevice.h
index ee01f0f..9dda68e 100644
--- a/libopie/odevice.h
+++ b/libopie/odevice.h
@@ -54,48 +54,52 @@ enum OSystem {
 enum OLedState {
         OLED_Off,
         OLED_On,
         OLED_BlinkSlow,
         OLED_BlinkFast
 };
 
 
 class ODevice
 {
 public:
 
 public:
         static ODevice *inst ( );
 
         // system
         enum PowerButtonHandler {
                 KERNEL,
                 OPIE
         };
 
         virtual bool setPowerButtonHandler ( PowerButtonHandler h );
         virtual bool suspend ( );
 
+        virtual bool setDisplayStatus ( bool on );
+        virtual bool setDisplayBrightness ( int brightness );
+        virtual int displayBrightnessResolution ( ) const;
+        
 // information
 
         QString modelString ( ); 
         OModel model ( );
         
         QString vendorString ( );
         OVendor vendor ( );
 
         QString systemString ( );
         OSystem system ( );
 
         QString systemVersionString ( );
 
 // input / output
 
         virtual void alarmSound ( );
         virtual void keySound ( );
         virtual void touchSound ( );
 
         virtual uint hasLeds ( ) const;
         virtual OLedState led ( uint which ) const;
         virtual bool setLed ( uint which, OLedState st );
 
         virtual ~ODevice ( );