1b2441318SGreg Kroah-Hartman // SPDX-License-Identifier: GPL-2.0
25474c120SMichael Hanselmann /*
35474c120SMichael Hanselmann * Backlight code for via-pmu
45474c120SMichael Hanselmann *
55474c120SMichael Hanselmann * Copyright (C) 1998 Paul Mackerras and Fabio Riccardi.
65474c120SMichael Hanselmann * Copyright (C) 2001-2002 Benjamin Herrenschmidt
75474c120SMichael Hanselmann * Copyright (C) 2006 Michael Hanselmann <linux-kernel@hansmi.ch>
85474c120SMichael Hanselmann *
95474c120SMichael Hanselmann */
105474c120SMichael Hanselmann
115474c120SMichael Hanselmann #include <asm/ptrace.h>
125474c120SMichael Hanselmann #include <linux/adb.h>
135474c120SMichael Hanselmann #include <linux/pmu.h>
145474c120SMichael Hanselmann #include <asm/backlight.h>
155474c120SMichael Hanselmann
165474c120SMichael Hanselmann #define MAX_PMU_LEVEL 0xFF
175474c120SMichael Hanselmann
18acc2472eSLionel Debroux static const struct backlight_ops pmu_backlight_data;
194efd587bSDavid Woodhouse static DEFINE_SPINLOCK(pmu_backlight_lock);
20fa19d634SBenjamin Herrenschmidt static int sleeping, uses_pmu_bl;
21d565dd3bSBenjamin Herrenschmidt static u8 bl_curve[FB_BACKLIGHT_LEVELS];
225474c120SMichael Hanselmann
pmu_backlight_init_curve(u8 off,u8 min,u8 max)23d565dd3bSBenjamin Herrenschmidt static void pmu_backlight_init_curve(u8 off, u8 min, u8 max)
24d565dd3bSBenjamin Herrenschmidt {
250094f2cdSBenjamin Herrenschmidt int i, flat, count, range = (max - min);
26d565dd3bSBenjamin Herrenschmidt
27d565dd3bSBenjamin Herrenschmidt bl_curve[0] = off;
28d565dd3bSBenjamin Herrenschmidt
29d565dd3bSBenjamin Herrenschmidt for (flat = 1; flat < (FB_BACKLIGHT_LEVELS / 16); ++flat)
30d565dd3bSBenjamin Herrenschmidt bl_curve[flat] = min;
31d565dd3bSBenjamin Herrenschmidt
32d565dd3bSBenjamin Herrenschmidt count = FB_BACKLIGHT_LEVELS * 15 / 16;
33d565dd3bSBenjamin Herrenschmidt for (i = 0; i < count; ++i)
34d565dd3bSBenjamin Herrenschmidt bl_curve[flat + i] = min + (range * (i + 1) / count);
35d565dd3bSBenjamin Herrenschmidt }
36d565dd3bSBenjamin Herrenschmidt
pmu_backlight_curve_lookup(int value)37d565dd3bSBenjamin Herrenschmidt static int pmu_backlight_curve_lookup(int value)
38d565dd3bSBenjamin Herrenschmidt {
39d565dd3bSBenjamin Herrenschmidt int level = (FB_BACKLIGHT_LEVELS - 1);
40d565dd3bSBenjamin Herrenschmidt int i, max = 0;
41d565dd3bSBenjamin Herrenschmidt
42d565dd3bSBenjamin Herrenschmidt /* Look for biggest value */
43d565dd3bSBenjamin Herrenschmidt for (i = 0; i < FB_BACKLIGHT_LEVELS; i++)
44d565dd3bSBenjamin Herrenschmidt max = max((int)bl_curve[i], max);
45d565dd3bSBenjamin Herrenschmidt
46d565dd3bSBenjamin Herrenschmidt /* Look for nearest value */
47d565dd3bSBenjamin Herrenschmidt for (i = 0; i < FB_BACKLIGHT_LEVELS; i++) {
48d565dd3bSBenjamin Herrenschmidt int diff = abs(bl_curve[i] - value);
49d565dd3bSBenjamin Herrenschmidt if (diff < max) {
50d565dd3bSBenjamin Herrenschmidt max = diff;
51d565dd3bSBenjamin Herrenschmidt level = i;
52d565dd3bSBenjamin Herrenschmidt }
53d565dd3bSBenjamin Herrenschmidt }
54d565dd3bSBenjamin Herrenschmidt return level;
55d565dd3bSBenjamin Herrenschmidt }
56d565dd3bSBenjamin Herrenschmidt
pmu_backlight_get_level_brightness(int level)57d565dd3bSBenjamin Herrenschmidt static int pmu_backlight_get_level_brightness(int level)
585474c120SMichael Hanselmann {
595474c120SMichael Hanselmann int pmulevel;
605474c120SMichael Hanselmann
615474c120SMichael Hanselmann /* Get and convert the value */
62d565dd3bSBenjamin Herrenschmidt pmulevel = bl_curve[level] * FB_BACKLIGHT_MAX / MAX_PMU_LEVEL;
635474c120SMichael Hanselmann if (pmulevel < 0)
645474c120SMichael Hanselmann pmulevel = 0;
655474c120SMichael Hanselmann else if (pmulevel > MAX_PMU_LEVEL)
665474c120SMichael Hanselmann pmulevel = MAX_PMU_LEVEL;
675474c120SMichael Hanselmann
685474c120SMichael Hanselmann return pmulevel;
695474c120SMichael Hanselmann }
705474c120SMichael Hanselmann
__pmu_backlight_update_status(struct backlight_device * bd)710094f2cdSBenjamin Herrenschmidt static int __pmu_backlight_update_status(struct backlight_device *bd)
725474c120SMichael Hanselmann {
735474c120SMichael Hanselmann struct adb_request req;
74*a0542d2cSStephen Kitt int level = backlight_get_brightness(bd);
755474c120SMichael Hanselmann
764b755999SMichael Hanselmann if (level > 0) {
77d565dd3bSBenjamin Herrenschmidt int pmulevel = pmu_backlight_get_level_brightness(level);
785474c120SMichael Hanselmann
795474c120SMichael Hanselmann pmu_request(&req, NULL, 2, PMU_BACKLIGHT_BRIGHT, pmulevel);
805474c120SMichael Hanselmann pmu_wait_complete(&req);
815474c120SMichael Hanselmann
825474c120SMichael Hanselmann pmu_request(&req, NULL, 2, PMU_POWER_CTRL,
834b755999SMichael Hanselmann PMU_POW_BACKLIGHT | PMU_POW_ON);
845474c120SMichael Hanselmann pmu_wait_complete(&req);
854b755999SMichael Hanselmann } else {
864b755999SMichael Hanselmann pmu_request(&req, NULL, 2, PMU_POWER_CTRL,
874b755999SMichael Hanselmann PMU_POW_BACKLIGHT | PMU_POW_OFF);
884b755999SMichael Hanselmann pmu_wait_complete(&req);
894b755999SMichael Hanselmann }
904b755999SMichael Hanselmann
915474c120SMichael Hanselmann return 0;
925474c120SMichael Hanselmann }
935474c120SMichael Hanselmann
pmu_backlight_update_status(struct backlight_device * bd)940094f2cdSBenjamin Herrenschmidt static int pmu_backlight_update_status(struct backlight_device *bd)
950094f2cdSBenjamin Herrenschmidt {
960094f2cdSBenjamin Herrenschmidt unsigned long flags;
970094f2cdSBenjamin Herrenschmidt int rc = 0;
980094f2cdSBenjamin Herrenschmidt
990094f2cdSBenjamin Herrenschmidt spin_lock_irqsave(&pmu_backlight_lock, flags);
1000094f2cdSBenjamin Herrenschmidt /* Don't update brightness when sleeping */
1010094f2cdSBenjamin Herrenschmidt if (!sleeping)
1020094f2cdSBenjamin Herrenschmidt rc = __pmu_backlight_update_status(bd);
1030094f2cdSBenjamin Herrenschmidt spin_unlock_irqrestore(&pmu_backlight_lock, flags);
1040094f2cdSBenjamin Herrenschmidt return rc;
1050094f2cdSBenjamin Herrenschmidt }
1060094f2cdSBenjamin Herrenschmidt
1070094f2cdSBenjamin Herrenschmidt
108acc2472eSLionel Debroux static const struct backlight_ops pmu_backlight_data = {
1095474c120SMichael Hanselmann .update_status = pmu_backlight_update_status,
110599a52d1SRichard Purdie
1115474c120SMichael Hanselmann };
1125474c120SMichael Hanselmann
1134b755999SMichael Hanselmann #ifdef CONFIG_PM
pmu_backlight_set_sleep(int sleep)114d565dd3bSBenjamin Herrenschmidt void pmu_backlight_set_sleep(int sleep)
1154b755999SMichael Hanselmann {
1164b755999SMichael Hanselmann unsigned long flags;
1174b755999SMichael Hanselmann
1184b755999SMichael Hanselmann spin_lock_irqsave(&pmu_backlight_lock, flags);
119d565dd3bSBenjamin Herrenschmidt sleeping = sleep;
120fa19d634SBenjamin Herrenschmidt if (pmac_backlight && uses_pmu_bl) {
1210094f2cdSBenjamin Herrenschmidt if (sleep) {
1220094f2cdSBenjamin Herrenschmidt struct adb_request req;
1230094f2cdSBenjamin Herrenschmidt
1240094f2cdSBenjamin Herrenschmidt pmu_request(&req, NULL, 2, PMU_POWER_CTRL,
1250094f2cdSBenjamin Herrenschmidt PMU_POW_BACKLIGHT | PMU_POW_OFF);
1260094f2cdSBenjamin Herrenschmidt pmu_wait_complete(&req);
1270094f2cdSBenjamin Herrenschmidt } else
1280094f2cdSBenjamin Herrenschmidt __pmu_backlight_update_status(pmac_backlight);
1290094f2cdSBenjamin Herrenschmidt }
1304b755999SMichael Hanselmann spin_unlock_irqrestore(&pmu_backlight_lock, flags);
1314b755999SMichael Hanselmann }
132d565dd3bSBenjamin Herrenschmidt #endif /* CONFIG_PM */
1334b755999SMichael Hanselmann
pmu_backlight_init(void)13400f7b29fSMathieu Malaterre void __init pmu_backlight_init(void)
1355474c120SMichael Hanselmann {
136a19a6ee6SMatthew Garrett struct backlight_properties props;
1375474c120SMichael Hanselmann struct backlight_device *bd;
1385474c120SMichael Hanselmann char name[10];
1395474c120SMichael Hanselmann int level, autosave;
1405474c120SMichael Hanselmann
1415474c120SMichael Hanselmann /* Special case for the old PowerBook since I can't test on it */
1425474c120SMichael Hanselmann autosave =
14371a157e8SGrant Likely of_machine_is_compatible("AAPL,3400/2400") ||
14471a157e8SGrant Likely of_machine_is_compatible("AAPL,3500");
1455474c120SMichael Hanselmann
1465474c120SMichael Hanselmann if (!autosave &&
1475474c120SMichael Hanselmann !pmac_has_backlight_type("pmu") &&
14871a157e8SGrant Likely !of_machine_is_compatible("AAPL,PowerBook1998") &&
14971a157e8SGrant Likely !of_machine_is_compatible("PowerBook1,1"))
1505474c120SMichael Hanselmann return;
1515474c120SMichael Hanselmann
152d565dd3bSBenjamin Herrenschmidt snprintf(name, sizeof(name), "pmubl");
1535474c120SMichael Hanselmann
154a19a6ee6SMatthew Garrett memset(&props, 0, sizeof(struct backlight_properties));
155bb7ca747SMatthew Garrett props.type = BACKLIGHT_PLATFORM;
156a19a6ee6SMatthew Garrett props.max_brightness = FB_BACKLIGHT_LEVELS - 1;
157a19a6ee6SMatthew Garrett bd = backlight_device_register(name, NULL, NULL, &pmu_backlight_data,
158a19a6ee6SMatthew Garrett &props);
1595474c120SMichael Hanselmann if (IS_ERR(bd)) {
1600094f2cdSBenjamin Herrenschmidt printk(KERN_ERR "PMU Backlight registration failed\n");
1610094f2cdSBenjamin Herrenschmidt return;
1625474c120SMichael Hanselmann }
163fa19d634SBenjamin Herrenschmidt uses_pmu_bl = 1;
164d565dd3bSBenjamin Herrenschmidt pmu_backlight_init_curve(0x7F, 0x46, 0x0E);
1655474c120SMichael Hanselmann
166599a52d1SRichard Purdie level = bd->props.max_brightness;
1675474c120SMichael Hanselmann
1685474c120SMichael Hanselmann if (autosave) {
1695474c120SMichael Hanselmann /* read autosaved value if available */
1705474c120SMichael Hanselmann struct adb_request req;
1715474c120SMichael Hanselmann pmu_request(&req, NULL, 2, 0xd9, 0);
1725474c120SMichael Hanselmann pmu_wait_complete(&req);
1735474c120SMichael Hanselmann
174d565dd3bSBenjamin Herrenschmidt level = pmu_backlight_curve_lookup(
1755474c120SMichael Hanselmann (req.reply[0] >> 4) *
176599a52d1SRichard Purdie bd->props.max_brightness / 15);
1775474c120SMichael Hanselmann }
1785474c120SMichael Hanselmann
179599a52d1SRichard Purdie bd->props.brightness = level;
180599a52d1SRichard Purdie bd->props.power = FB_BLANK_UNBLANK;
18128ee086dSRichard Purdie backlight_update_status(bd);
1825474c120SMichael Hanselmann
1830094f2cdSBenjamin Herrenschmidt printk(KERN_INFO "PMU Backlight initialized (%s)\n", name);
1845474c120SMichael Hanselmann }
185