linux 2.6.16.38 w/ vs2.0.3-rc1
[linux-2.6.git] / drivers / video / backlight / corgi_bl.c
index 2ebbfd9..d0aaf45 100644 (file)
@@ -1,7 +1,7 @@
 /*
- *  Backlight Driver for Sharp Zaurus Handhelds (various models)
+ *  Backlight Driver for Sharp Corgi
  *
- *  Copyright (c) 2004-2006 Richard Purdie
+ *  Copyright (c) 2004-2005 Richard Purdie
  *
  *  Based on Sharp's 2.4 Backlight Driver
  *
 #include <linux/kernel.h>
 #include <linux/init.h>
 #include <linux/platform_device.h>
-#include <linux/mutex.h>
+#include <linux/spinlock.h>
 #include <linux/fb.h>
 #include <linux/backlight.h>
+
 #include <asm/arch/sharpsl.h>
 #include <asm/hardware/sharpsl_pm.h>
 
-static int corgibl_intensity;
-static DEFINE_MUTEX(bl_mutex);
-static struct backlight_properties corgibl_data;
-static struct backlight_device *corgi_backlight_device;
-static struct corgibl_machinfo *bl_machinfo;
+#define CORGI_DEFAULT_INTENSITY                0x1f
+#define CORGI_LIMIT_MASK               0x0b
 
-static unsigned long corgibl_flags;
-#define CORGIBL_SUSPENDED     0x01
-#define CORGIBL_BATTLOW       0x02
+static int corgibl_powermode = FB_BLANK_UNBLANK;
+static int current_intensity = 0;
+static int corgibl_limit = 0;
+static void (*corgibl_mach_set_intensity)(int intensity);
+static spinlock_t bl_lock = SPIN_LOCK_UNLOCKED;
+static struct backlight_properties corgibl_data;
 
-static int corgibl_send_intensity(struct backlight_device *bd)
+static void corgibl_send_intensity(int intensity)
 {
+       unsigned long flags;
        void (*corgi_kick_batt)(void);
-       int intensity = bd->props->brightness;
 
-       if (bd->props->power != FB_BLANK_UNBLANK)
-               intensity = 0;
-       if (bd->props->fb_blank != FB_BLANK_UNBLANK)
-               intensity = 0;
-       if (corgibl_flags & CORGIBL_SUSPENDED)
+       if (corgibl_powermode != FB_BLANK_UNBLANK) {
                intensity = 0;
-       if (corgibl_flags & CORGIBL_BATTLOW)
-               intensity &= bl_machinfo->limit_mask;
+       } else {
+               if (corgibl_limit)
+                       intensity &= CORGI_LIMIT_MASK;
+       }
 
-       mutex_lock(&bl_mutex);
-       bl_machinfo->set_bl_intensity(intensity);
-       mutex_unlock(&bl_mutex);
+       spin_lock_irqsave(&bl_lock, flags);
 
-       corgibl_intensity = intensity;
+       corgibl_mach_set_intensity(intensity);
+
+       spin_unlock_irqrestore(&bl_lock, flags);
 
        corgi_kick_batt = symbol_get(sharpsl_battery_kick);
        if (corgi_kick_batt) {
                corgi_kick_batt();
                symbol_put(sharpsl_battery_kick);
        }
+}
 
-       return 0;
+static void corgibl_blank(int blank)
+{
+       switch(blank) {
+
+       case FB_BLANK_NORMAL:
+       case FB_BLANK_VSYNC_SUSPEND:
+       case FB_BLANK_HSYNC_SUSPEND:
+       case FB_BLANK_POWERDOWN:
+               if (corgibl_powermode == FB_BLANK_UNBLANK) {
+                       corgibl_send_intensity(0);
+                       corgibl_powermode = blank;
+               }
+               break;
+       case FB_BLANK_UNBLANK:
+               if (corgibl_powermode != FB_BLANK_UNBLANK) {
+                       corgibl_powermode = blank;
+                       corgibl_send_intensity(current_intensity);
+               }
+               break;
+       }
 }
 
 #ifdef CONFIG_PM
 static int corgibl_suspend(struct platform_device *dev, pm_message_t state)
 {
-       corgibl_flags |= CORGIBL_SUSPENDED;
-       corgibl_send_intensity(corgi_backlight_device);
+       corgibl_blank(FB_BLANK_POWERDOWN);
        return 0;
 }
 
 static int corgibl_resume(struct platform_device *dev)
 {
-       corgibl_flags &= ~CORGIBL_SUSPENDED;
-       corgibl_send_intensity(corgi_backlight_device);
+       corgibl_blank(FB_BLANK_UNBLANK);
        return 0;
 }
 #else
@@ -79,55 +96,68 @@ static int corgibl_resume(struct platform_device *dev)
 #define corgibl_resume NULL
 #endif
 
-static int corgibl_get_intensity(struct backlight_device *bd)
+
+static int corgibl_set_power(struct backlight_device *bd, int state)
 {
-       return corgibl_intensity;
+       corgibl_blank(state);
+       return 0;
+}
+
+static int corgibl_get_power(struct backlight_device *bd)
+{
+       return corgibl_powermode;
 }
 
-static int corgibl_set_intensity(struct backlight_device *bd)
+static int corgibl_set_intensity(struct backlight_device *bd, int intensity)
 {
-       corgibl_send_intensity(corgi_backlight_device);
+       if (intensity > corgibl_data.max_brightness)
+               intensity = corgibl_data.max_brightness;
+       corgibl_send_intensity(intensity);
+       current_intensity=intensity;
        return 0;
 }
 
+static int corgibl_get_intensity(struct backlight_device *bd)
+{
+       return current_intensity;
+}
+
 /*
  * Called when the battery is low to limit the backlight intensity.
  * If limit==0 clear any limit, otherwise limit the intensity
  */
 void corgibl_limit_intensity(int limit)
 {
-       if (limit)
-               corgibl_flags |= CORGIBL_BATTLOW;
-       else
-               corgibl_flags &= ~CORGIBL_BATTLOW;
-       corgibl_send_intensity(corgi_backlight_device);
+       corgibl_limit = (limit ? 1 : 0);
+       corgibl_send_intensity(current_intensity);
 }
 EXPORT_SYMBOL(corgibl_limit_intensity);
 
 
 static struct backlight_properties corgibl_data = {
-       .owner          = THIS_MODULE,
+       .owner          = THIS_MODULE,
+       .get_power      = corgibl_get_power,
+       .set_power      = corgibl_set_power,
        .get_brightness = corgibl_get_intensity,
-       .update_status  = corgibl_set_intensity,
+       .set_brightness = corgibl_set_intensity,
 };
 
+static struct backlight_device *corgi_backlight_device;
+
 static int __init corgibl_probe(struct platform_device *pdev)
 {
        struct corgibl_machinfo *machinfo = pdev->dev.platform_data;
 
-       bl_machinfo = machinfo;
        corgibl_data.max_brightness = machinfo->max_intensity;
-       if (!machinfo->limit_mask)
-               machinfo->limit_mask = -1;
+       corgibl_mach_set_intensity = machinfo->set_bl_intensity;
 
        corgi_backlight_device = backlight_device_register ("corgi-bl",
                NULL, &corgibl_data);
        if (IS_ERR (corgi_backlight_device))
                return PTR_ERR (corgi_backlight_device);
 
-       corgibl_data.power = FB_BLANK_UNBLANK;
-       corgibl_data.brightness = machinfo->default_intensity;
-       corgibl_send_intensity(corgi_backlight_device);
+       corgibl_set_intensity(NULL, CORGI_DEFAULT_INTENSITY);
+       corgibl_limit_intensity(0);
 
        printk("Corgi Backlight Driver Initialized.\n");
        return 0;
@@ -137,6 +167,8 @@ static int corgibl_remove(struct platform_device *dev)
 {
        backlight_device_unregister(corgi_backlight_device);
 
+       corgibl_set_intensity(NULL, 0);
+
        printk("Corgi Backlight Driver Unloaded\n");
        return 0;
 }