| -rw-r--r-- | libopie2/opiecore/device/odevice_simpad.cpp | 83 |
1 files changed, 66 insertions, 17 deletions
diff --git a/libopie2/opiecore/device/odevice_simpad.cpp b/libopie2/opiecore/device/odevice_simpad.cpp index 2d0160d..fd46b95 100644 --- a/libopie2/opiecore/device/odevice_simpad.cpp +++ b/libopie2/opiecore/device/odevice_simpad.cpp @@ -175,96 +175,148 @@ void SIMpad::initButtons() // SIMpad boardcontrol register CS3 #define SIMPAD_BOARDCONTROL "/proc/cs3" #define SIMPAD_VCC_5V_EN 0x0001 // For 5V PCMCIA #define SIMPAD_VCC_3V_EN 0x0002 // FOR 3.3V PCMCIA #define SIMPAD_EN1 0x0004 // This is only for EPROM's #define SIMPAD_EN0 0x0008 // Both should be enable for 3.3V or 5V #define SIMPAD_DISPLAY_ON 0x0010 #define SIMPAD_PCMCIA_BUFF_DIS 0x0020 #define SIMPAD_MQ_RESET 0x0040 #define SIMPAD_PCMCIA_RESET 0x0080 #define SIMPAD_DECT_POWER_ON 0x0100 #define SIMPAD_IRDA_SD 0x0200 // Shutdown for powersave #define SIMPAD_RS232_ON 0x0400 #define SIMPAD_SD_MEDIAQ 0x0800 // Shutdown for powersave #define SIMPAD_LED2_ON 0x1000 #define SIMPAD_IRDA_MODE 0x2000 // Fast/Slow IrDA mode #define SIMPAD_ENABLE_5V 0x4000 // Enable 5V circuit #define SIMPAD_RESET_SIMCARD 0x8000 //SIMpad touchscreen backlight strength control #define SIMPAD_BACKLIGHT_CONTROL "/proc/driver/mq200/registers/PWM_CONTROL" #define SIMPAD_BACKLIGHT_MASK 0x00a10044 + +/* + * The SIMpad exposes ChipSelect3 to userspace + * via a proc filesystem file. Using this register + * one can toggle power of serial, irda, dect circuits + * change the video driver and display status and + * many more things. + * To not lose the current setting we read the current + * cs3 setting and toggle the necessary bits and then + * write it. + */ +static bool setCS3Bit( bool bitset, int bit ) { + int cs3_fd = ::open( SIMPAD_BOARDCONTROL, O_RDONLY ); + + if ( cs3_fd < 0 ) + return false; + + static char line[32]; + int val = 0; + bool ok = false; + + /* + * try to read and parse the Chipselect3 status + * be paranoid and make sure line[31] is null + * terminated + */ + while( !ok && ::read(cs3_fd, &line, sizeof(line)) > 0 ) { + line[31] = '\0'; + if (::sscanf(line, "Chipselect3 : %x", &val )) + ok = true; + } + + ::close(cs3_fd); + + /* + * we were not able to find the current value + * and as a result we won't set it + */ + if ( !ok ) + return false; + + /* + * change the value + */ + val = bitset ? (val | bit) : (val & ~bit); + + /* + * write it back + */ + cs3_fd = ::open( SIMPAD_BOARDCONTROL, O_WRONLY ); + if ( cs3_fd < 0 ) + return false; + + ::snprintf(line, sizeof(line), "0x%04x\n", val); + ::write(cs3_fd, line, strlen(line)); + ::close(cs3_fd); + + return true; +} + + QValueList <OLed> SIMpad::ledList() const { QValueList <OLed> vl; vl << Led_Power; //FIXME which LED is LED2 ? The green one or the amber one? //vl << Led_Mail; //TODO find out if LED1 is accessible anyway return vl; } QValueList <OLedState> SIMpad::ledStateList ( OLed l ) const { QValueList <OLedState> vl; if ( l == Led_Power ) //FIXME which LED is LED2 ? The green one or the amber one? vl << Led_Off << Led_On; //else if ( l == Led_Mail ) //TODO find out if LED1 is accessible anyway //vl << Led_Off; return vl; } OLedState SIMpad::ledState ( OLed l ) const { switch ( l ) { case Led_Power: return m_leds [0]; //case Led_Mail: // return m_leds [1]; default: return Led_Off; } } bool SIMpad::setLedState ( OLed l, OLedState st ) { -#if 0 - static int fd = ::open ( SIMPAD_BOARDCONTROL, O_RDWR | O_NONBLOCK ); - - /*TODO Implement this like that: - read from cs3 - && with SIMPAD_LED2_ON - write to cs3 */ + if ( l == Led_Power ) { m_leds [0] = st; + setCS3Bit(st == Led_On, SIMPAD_LED2_ON); return true; - // } -// } -#else - Q_UNUSED( l ) - Q_UNUSED( st ) -#endif + } + return false; } bool SIMpad::filter ( int /*unicode*/, int /*keycode*/, int /*modifiers*/, bool /*isPress*/, bool /*autoRepeat*/ ) { //TODO return false; } void SIMpad::timerEvent ( QTimerEvent * ) { killTimer ( m_power_timer ); m_power_timer = 0; QWSServer::sendKeyEvent ( -1, HardKey_Backlight, 0, true, false ); QWSServer::sendKeyEvent ( -1, HardKey_Backlight, 0, false, false ); } void SIMpad::playAlarmSound() { #ifndef QT_NO_SOUND static Sound snd ( "alarm" ); @@ -289,52 +341,49 @@ bool SIMpad::suspend() // Must override because SIMpad does NOT have apm (void)::system( "cat /dev/fb/0 > /tmp/.buffer" ); bool res = ODevice::suspend(); /* * restore */ if ( res ) ::system( "cat /tmp/.buffer > /dev/fb/0" ); return res; } bool SIMpad::setSoftSuspend ( bool soft ) { qDebug( "ODevice for SIMpad: UNHANDLED setSoftSuspend(%s)", soft? "on" : "off" ); return false; } bool SIMpad::setDisplayStatus ( bool on ) { qDebug( "ODevice for SIMpad: setDisplayStatus(%s)", on? "on" : "off" ); - - QString cmdline = QString().sprintf( "echo %s > /proc/cs3", on ? "0xd41a" : "0xd40a" ); //TODO make better :) - - return ( ::system( (const char*) cmdline ) == 0 ); + return setCS3Bit(on, SIMPAD_DISPLAY_ON); } bool SIMpad::setDisplayBrightness ( int bright ) { qDebug( "ODevice for SIMpad: setDisplayBrightness( %d )", bright ); bool res = false; int fd; if ( bright > 255 ) bright = 255; if ( bright < 1 ) bright = 0; if (( fd = ::open ( SIMPAD_BACKLIGHT_CONTROL, O_WRONLY )) >= 0 ) { int value = 255 - bright; const int mask = SIMPAD_BACKLIGHT_MASK; value = value << 8; value += mask; char writeCommand[100]; const int count = snprintf( writeCommand, sizeof(writeCommand), "0x%x\n", value ); res = ( ::write ( fd, writeCommand, count ) != -1 ); ::close ( fd ); } |