Eric Lee / smarc-fsl-linux-kernel

Blame view

drivers/leds/leds-ip30.c 1.76 KB
edit raw normal view history
64d7e2311   Thomas Bogendoerfer   leds: add SGI IP3... 
1
2
3
4
 
  // SPDX-License-Identifier: GPL-2.0
  /*
   * LED Driver for SGI Octane machines
   */
2aebb7804   Marek Behún   leds: ip30: compi... 
5
 
  #include <asm/io.h>
64d7e2311   Thomas Bogendoerfer   leds: add SGI IP3... 
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
 
  #include <linux/module.h>
  #include <linux/kernel.h>
  #include <linux/platform_device.h>
  #include <linux/leds.h>
  
  #define IP30_LED_SYSTEM	0
  #define IP30_LED_FAULT	1
  
  struct ip30_led {
  	struct led_classdev cdev;
  	u32 __iomem *reg;
  };
  
  static void ip30led_set(struct led_classdev *led_cdev,
  			enum led_brightness value)
  {
  	struct ip30_led *led = container_of(led_cdev, struct ip30_led, cdev);
  
  	writel(value, led->reg);
  }
  
  static int ip30led_create(struct platform_device *pdev, int num)
  {
  	struct resource *res;
  	struct ip30_led *data;
  
  	res = platform_get_resource(pdev, IORESOURCE_MEM, num);
  	if (!res)
  		return -EBUSY;
  
  	data = devm_kzalloc(&pdev->dev, sizeof(*data), GFP_KERNEL);
  	if (!data)
  		return -ENOMEM;
  
  	data->reg = devm_ioremap_resource(&pdev->dev, res);
  	if (IS_ERR(data->reg))
  		return PTR_ERR(data->reg);
  
  
  	switch (num) {
  	case IP30_LED_SYSTEM:
19aa98409   Pavel Machek   leds: ip30: label... 
47
 
  		data->cdev.name = "white:power";
64d7e2311   Thomas Bogendoerfer   leds: add SGI IP3... 
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
 
  		break;
  	case IP30_LED_FAULT:
  		data->cdev.name = "red:fault";
  		break;
  	default:
  		return -EINVAL;
  	}
  
  	data->cdev.brightness = readl(data->reg);
  	data->cdev.max_brightness = 1;
  	data->cdev.brightness_set = ip30led_set;
  
  	return devm_led_classdev_register(&pdev->dev, &data->cdev);
  }
  
  static int ip30led_probe(struct platform_device *pdev)
  {
  	int ret;
  
  	ret = ip30led_create(pdev, IP30_LED_SYSTEM);
  	if (ret < 0)
  		return ret;
  
  	return ip30led_create(pdev, IP30_LED_FAULT);
  }
  
  static struct platform_driver ip30led_driver = {
  	.probe		= ip30led_probe,
  	.driver		= {
  		.name		= "ip30-leds",
  	},
  };
  
  module_platform_driver(ip30led_driver);
  
  MODULE_AUTHOR("Thomas Bogendoerfer <tbogendoerfer@suse.de>");
  MODULE_DESCRIPTION("SGI Octane LED driver");
  MODULE_LICENSE("GPL");
  MODULE_ALIAS("platform:ip30-leds");