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
@@ -11,148 +11,167 @@
     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
@@ -164,32 +183,67 @@ bool ODevice::suspend ( )
 
 			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;
 }
 
@@ -230,61 +284,62 @@ 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" )
@@ -302,43 +357,47 @@ void ODeviceIPAQ::init ( )
 	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" );
@@ -377,33 +436,33 @@ uint ODeviceIPAQ::hasLeds ( ) const
 }
 
 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;
@@ -420,33 +479,70 @@ bool ODeviceIPAQ::setPowerButtonHandler ( ODevice::PowerButtonHandler p )
 	
 	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;
 
@@ -507,36 +603,37 @@ void ODeviceZaurus::init ( )
 #define	SHARP_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 );
 }
 
@@ -608,16 +705,43 @@ bool ODeviceZaurus::setPowerButtonHandler ( ODevice::PowerButtonHandler p )
 
 			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
@@ -62,32 +62,36 @@ enum OLedState {
 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 ( );