1// SPDX-License-Identifier: GPL-2.0-only
  2/*
  3 * LED Driver for the Freecom FSG-3
  4 *
  5 * Copyright (c) 2008 Rod Whitby <rod@whitby.id.au>
  6 *
  7 * Author: Rod Whitby <rod@whitby.id.au>
  8 *
  9 * Based on leds-spitz.c
 10 * Copyright 2005-2006 Openedhand Ltd.
 11 * Author: Richard Purdie <rpurdie@openedhand.com>
 12 */
 13
 14#include <linux/kernel.h>
 15#include <linux/platform_device.h>
 16#include <linux/leds.h>
 17#include <linux/module.h>
 18#include <linux/io.h>
 19#include <mach/hardware.h>
 20
 21#define FSG_LED_WLAN_BIT	0
 22#define FSG_LED_WAN_BIT		1
 23#define FSG_LED_SATA_BIT	2
 24#define FSG_LED_USB_BIT		4
 25#define FSG_LED_RING_BIT	5
 26#define FSG_LED_SYNC_BIT	7
 27
 28static short __iomem *latch_address;
 29static unsigned short latch_value;
 30
 31
 32static void fsg_led_wlan_set(struct led_classdev *led_cdev,
 33			     enum led_brightness value)
 34{
 35	if (value) {
 36		latch_value &= ~(1 << FSG_LED_WLAN_BIT);
 37		*latch_address = latch_value;
 38	} else {
 39		latch_value |=  (1 << FSG_LED_WLAN_BIT);
 40		*latch_address = latch_value;
 41	}
 42}
 43
 44static void fsg_led_wan_set(struct led_classdev *led_cdev,
 45			    enum led_brightness value)
 46{
 47	if (value) {
 48		latch_value &= ~(1 << FSG_LED_WAN_BIT);
 49		*latch_address = latch_value;
 50	} else {
 51		latch_value |=  (1 << FSG_LED_WAN_BIT);
 52		*latch_address = latch_value;
 53	}
 54}
 55
 56static void fsg_led_sata_set(struct led_classdev *led_cdev,
 57			     enum led_brightness value)
 58{
 59	if (value) {
 60		latch_value &= ~(1 << FSG_LED_SATA_BIT);
 61		*latch_address = latch_value;
 62	} else {
 63		latch_value |=  (1 << FSG_LED_SATA_BIT);
 64		*latch_address = latch_value;
 65	}
 66}
 67
 68static void fsg_led_usb_set(struct led_classdev *led_cdev,
 69			    enum led_brightness value)
 70{
 71	if (value) {
 72		latch_value &= ~(1 << FSG_LED_USB_BIT);
 73		*latch_address = latch_value;
 74	} else {
 75		latch_value |=  (1 << FSG_LED_USB_BIT);
 76		*latch_address = latch_value;
 77	}
 78}
 79
 80static void fsg_led_sync_set(struct led_classdev *led_cdev,
 81			     enum led_brightness value)
 82{
 83	if (value) {
 84		latch_value &= ~(1 << FSG_LED_SYNC_BIT);
 85		*latch_address = latch_value;
 86	} else {
 87		latch_value |=  (1 << FSG_LED_SYNC_BIT);
 88		*latch_address = latch_value;
 89	}
 90}
 91
 92static void fsg_led_ring_set(struct led_classdev *led_cdev,
 93			     enum led_brightness value)
 94{
 95	if (value) {
 96		latch_value &= ~(1 << FSG_LED_RING_BIT);
 97		*latch_address = latch_value;
 98	} else {
 99		latch_value |=  (1 << FSG_LED_RING_BIT);
100		*latch_address = latch_value;
101	}
102}
103
104
105static struct led_classdev fsg_wlan_led = {
106	.name			= "fsg:blue:wlan",
107	.brightness_set		= fsg_led_wlan_set,
108	.flags			= LED_CORE_SUSPENDRESUME,
109};
110
111static struct led_classdev fsg_wan_led = {
112	.name			= "fsg:blue:wan",
113	.brightness_set		= fsg_led_wan_set,
114	.flags			= LED_CORE_SUSPENDRESUME,
115};
116
117static struct led_classdev fsg_sata_led = {
118	.name			= "fsg:blue:sata",
119	.brightness_set		= fsg_led_sata_set,
120	.flags			= LED_CORE_SUSPENDRESUME,
121};
122
123static struct led_classdev fsg_usb_led = {
124	.name			= "fsg:blue:usb",
125	.brightness_set		= fsg_led_usb_set,
126	.flags			= LED_CORE_SUSPENDRESUME,
127};
128
129static struct led_classdev fsg_sync_led = {
130	.name			= "fsg:blue:sync",
131	.brightness_set		= fsg_led_sync_set,
132	.flags			= LED_CORE_SUSPENDRESUME,
133};
134
135static struct led_classdev fsg_ring_led = {
136	.name			= "fsg:blue:ring",
137	.brightness_set		= fsg_led_ring_set,
138	.flags			= LED_CORE_SUSPENDRESUME,
139};
140
141
142static int fsg_led_probe(struct platform_device *pdev)
143{
144	int ret;
145
146	/* Map the LED chip select address space */
147	latch_address = (unsigned short *) devm_ioremap(&pdev->dev,
148						IXP4XX_EXP_BUS_BASE(2), 512);
149	if (!latch_address)
150		return -ENOMEM;
151
152	latch_value = 0xffff;
153	*latch_address = latch_value;
154
155	ret = devm_led_classdev_register(&pdev->dev, &fsg_wlan_led);
156	if (ret < 0)
157		return ret;
158
159	ret = devm_led_classdev_register(&pdev->dev, &fsg_wan_led);
160	if (ret < 0)
161		return ret;
162
163	ret = devm_led_classdev_register(&pdev->dev, &fsg_sata_led);
164	if (ret < 0)
165		return ret;
166
167	ret = devm_led_classdev_register(&pdev->dev, &fsg_usb_led);
168	if (ret < 0)
169		return ret;
170
171	ret = devm_led_classdev_register(&pdev->dev, &fsg_sync_led);
172	if (ret < 0)
173		return ret;
174
175	ret = devm_led_classdev_register(&pdev->dev, &fsg_ring_led);
176	if (ret < 0)
177		return ret;
178
179	return ret;
180}
181
182static struct platform_driver fsg_led_driver = {
183	.probe		= fsg_led_probe,
184	.driver		= {
185		.name		= "fsg-led",
186	},
187};
188
189module_platform_driver(fsg_led_driver);
190
191MODULE_AUTHOR("Rod Whitby <rod@whitby.id.au>");
192MODULE_DESCRIPTION("Freecom FSG-3 LED driver");
193MODULE_LICENSE("GPL");