cachepc-linux

Fork of AMDESE/linux with modifications for CachePC side-channel attack
git clone https://git.sinitax.com/sinitax/cachepc-linux
Log | Files | Refs | README | LICENSE | sfeed.txt

locomolcd.c (6257B)


      1// SPDX-License-Identifier: GPL-2.0-only
      2/*
      3 * Backlight control code for Sharp Zaurus SL-5500
      4 *
      5 * Copyright 2005 John Lenz <lenz@cs.wisc.edu>
      6 * Maintainer: Pavel Machek <pavel@ucw.cz> (unless John wants to :-)
      7 *
      8 * This driver assumes single CPU. That's okay, because collie is
      9 * slightly old hardware, and no one is going to retrofit second CPU to
     10 * old PDA.
     11 */
     12
     13/* LCD power functions */
     14#include <linux/module.h>
     15#include <linux/init.h>
     16#include <linux/delay.h>
     17#include <linux/device.h>
     18#include <linux/interrupt.h>
     19#include <linux/fb.h>
     20#include <linux/backlight.h>
     21
     22#include <asm/hardware/locomo.h>
     23#include <asm/irq.h>
     24#include <asm/mach/sharpsl_param.h>
     25#include <asm/mach-types.h>
     26
     27#include "../../../arch/arm/mach-sa1100/generic.h"
     28
     29static struct backlight_device *locomolcd_bl_device;
     30static struct locomo_dev *locomolcd_dev;
     31static unsigned long locomolcd_flags;
     32#define LOCOMOLCD_SUSPENDED     0x01
     33
     34static void locomolcd_on(int comadj)
     35{
     36	locomo_gpio_set_dir(locomolcd_dev->dev.parent, LOCOMO_GPIO_LCD_VSHA_ON, 0);
     37	locomo_gpio_write(locomolcd_dev->dev.parent, LOCOMO_GPIO_LCD_VSHA_ON, 1);
     38	mdelay(2);
     39
     40	locomo_gpio_set_dir(locomolcd_dev->dev.parent, LOCOMO_GPIO_LCD_VSHD_ON, 0);
     41	locomo_gpio_write(locomolcd_dev->dev.parent, LOCOMO_GPIO_LCD_VSHD_ON, 1);
     42	mdelay(2);
     43
     44	locomo_m62332_senddata(locomolcd_dev, comadj, 0);
     45	mdelay(5);
     46
     47	locomo_gpio_set_dir(locomolcd_dev->dev.parent, LOCOMO_GPIO_LCD_VEE_ON, 0);
     48	locomo_gpio_write(locomolcd_dev->dev.parent, LOCOMO_GPIO_LCD_VEE_ON, 1);
     49	mdelay(10);
     50
     51	/* TFTCRST | CPSOUT=0 | CPSEN */
     52	locomo_writel(0x01, locomolcd_dev->mapbase + LOCOMO_TC);
     53
     54	/* Set CPSD */
     55	locomo_writel(6, locomolcd_dev->mapbase + LOCOMO_CPSD);
     56
     57	/* TFTCRST | CPSOUT=0 | CPSEN */
     58	locomo_writel((0x04 | 0x01), locomolcd_dev->mapbase + LOCOMO_TC);
     59	mdelay(10);
     60
     61	locomo_gpio_set_dir(locomolcd_dev->dev.parent, LOCOMO_GPIO_LCD_MOD, 0);
     62	locomo_gpio_write(locomolcd_dev->dev.parent, LOCOMO_GPIO_LCD_MOD, 1);
     63}
     64
     65static void locomolcd_off(int comadj)
     66{
     67	/* TFTCRST=1 | CPSOUT=1 | CPSEN = 0 */
     68	locomo_writel(0x06, locomolcd_dev->mapbase + LOCOMO_TC);
     69	mdelay(1);
     70
     71	locomo_gpio_write(locomolcd_dev->dev.parent, LOCOMO_GPIO_LCD_VSHA_ON, 0);
     72	mdelay(110);
     73
     74	locomo_gpio_write(locomolcd_dev->dev.parent, LOCOMO_GPIO_LCD_VEE_ON, 0);
     75	mdelay(700);
     76
     77	/* TFTCRST=0 | CPSOUT=0 | CPSEN = 0 */
     78	locomo_writel(0, locomolcd_dev->mapbase + LOCOMO_TC);
     79	locomo_gpio_write(locomolcd_dev->dev.parent, LOCOMO_GPIO_LCD_MOD, 0);
     80	locomo_gpio_write(locomolcd_dev->dev.parent, LOCOMO_GPIO_LCD_VSHD_ON, 0);
     81}
     82
     83void locomolcd_power(int on)
     84{
     85	int comadj = sharpsl_param.comadj;
     86	unsigned long flags;
     87
     88	local_irq_save(flags);
     89
     90	if (!locomolcd_dev) {
     91		local_irq_restore(flags);
     92		return;
     93	}
     94
     95	/* read comadj */
     96	if (comadj == -1 && machine_is_collie())
     97		comadj = 128;
     98	if (comadj == -1 && machine_is_poodle())
     99		comadj = 118;
    100
    101	if (on)
    102		locomolcd_on(comadj);
    103	else
    104		locomolcd_off(comadj);
    105
    106	local_irq_restore(flags);
    107}
    108EXPORT_SYMBOL(locomolcd_power);
    109
    110static int current_intensity;
    111
    112static int locomolcd_set_intensity(struct backlight_device *bd)
    113{
    114	int intensity = backlight_get_brightness(bd);
    115
    116	if (locomolcd_flags & LOCOMOLCD_SUSPENDED)
    117		intensity = 0;
    118
    119	switch (intensity) {
    120	/*
    121	 * AC and non-AC are handled differently,
    122	 * but produce same results in sharp code?
    123	 */
    124	case 0:
    125		locomo_frontlight_set(locomolcd_dev, 0, 0, 161);
    126		break;
    127	case 1:
    128		locomo_frontlight_set(locomolcd_dev, 117, 0, 161);
    129		break;
    130	case 2:
    131		locomo_frontlight_set(locomolcd_dev, 163, 0, 148);
    132		break;
    133	case 3:
    134		locomo_frontlight_set(locomolcd_dev, 194, 0, 161);
    135		break;
    136	case 4:
    137		locomo_frontlight_set(locomolcd_dev, 194, 1, 161);
    138		break;
    139	default:
    140		return -ENODEV;
    141	}
    142	current_intensity = intensity;
    143	return 0;
    144}
    145
    146static int locomolcd_get_intensity(struct backlight_device *bd)
    147{
    148	return current_intensity;
    149}
    150
    151static const struct backlight_ops locomobl_data = {
    152	.get_brightness = locomolcd_get_intensity,
    153	.update_status  = locomolcd_set_intensity,
    154};
    155
    156#ifdef CONFIG_PM_SLEEP
    157static int locomolcd_suspend(struct device *dev)
    158{
    159	locomolcd_flags |= LOCOMOLCD_SUSPENDED;
    160	locomolcd_set_intensity(locomolcd_bl_device);
    161	return 0;
    162}
    163
    164static int locomolcd_resume(struct device *dev)
    165{
    166	locomolcd_flags &= ~LOCOMOLCD_SUSPENDED;
    167	locomolcd_set_intensity(locomolcd_bl_device);
    168	return 0;
    169}
    170#endif
    171
    172static SIMPLE_DEV_PM_OPS(locomolcd_pm_ops, locomolcd_suspend, locomolcd_resume);
    173
    174static int locomolcd_probe(struct locomo_dev *ldev)
    175{
    176	struct backlight_properties props;
    177	unsigned long flags;
    178
    179	local_irq_save(flags);
    180	locomolcd_dev = ldev;
    181
    182	locomo_gpio_set_dir(ldev->dev.parent, LOCOMO_GPIO_FL_VR, 0);
    183
    184	/*
    185	 * the poodle_lcd_power function is called for the first time
    186	 * from fs_initcall, which is before locomo is activated.
    187	 * We need to recall poodle_lcd_power here
    188	 */
    189	if (machine_is_poodle())
    190		locomolcd_power(1);
    191
    192	local_irq_restore(flags);
    193
    194	memset(&props, 0, sizeof(struct backlight_properties));
    195	props.type = BACKLIGHT_RAW;
    196	props.max_brightness = 4;
    197	locomolcd_bl_device = backlight_device_register("locomo-bl",
    198							&ldev->dev, NULL,
    199							&locomobl_data, &props);
    200
    201	if (IS_ERR(locomolcd_bl_device))
    202		return PTR_ERR(locomolcd_bl_device);
    203
    204	/* Set up frontlight so that screen is readable */
    205	locomolcd_bl_device->props.brightness = 2;
    206	locomolcd_set_intensity(locomolcd_bl_device);
    207
    208	return 0;
    209}
    210
    211static void locomolcd_remove(struct locomo_dev *dev)
    212{
    213	unsigned long flags;
    214
    215	locomolcd_bl_device->props.brightness = 0;
    216	locomolcd_bl_device->props.power = 0;
    217	locomolcd_set_intensity(locomolcd_bl_device);
    218
    219	backlight_device_unregister(locomolcd_bl_device);
    220	local_irq_save(flags);
    221	locomolcd_dev = NULL;
    222	local_irq_restore(flags);
    223}
    224
    225static struct locomo_driver poodle_lcd_driver = {
    226	.drv = {
    227		.name	= "locomo-backlight",
    228		.pm	= &locomolcd_pm_ops,
    229	},
    230	.devid	= LOCOMO_DEVID_BACKLIGHT,
    231	.probe	= locomolcd_probe,
    232	.remove	= locomolcd_remove,
    233};
    234
    235static int __init locomolcd_init(void)
    236{
    237	return locomo_driver_register(&poodle_lcd_driver);
    238}
    239
    240static void __exit locomolcd_exit(void)
    241{
    242	locomo_driver_unregister(&poodle_lcd_driver);
    243}
    244
    245module_init(locomolcd_init);
    246module_exit(locomolcd_exit);
    247
    248MODULE_AUTHOR("John Lenz <lenz@cs.wisc.edu>, Pavel Machek <pavel@ucw.cz>");
    249MODULE_DESCRIPTION("Collie LCD driver");
    250MODULE_LICENSE("GPL");