dev-leds-gpio.c

Go to the documentation of this file.

/*
 *  Atheros AR71XX/AR724X/AR913X common GPIO LEDs support
 *
 *  Copyright (C) 2008-2010 Gabor Juhos <[email protected]>
 *  Copyright (C) 2008 Imre Kaloz <[email protected]>
 *
 *  This program is free software; you can redistribute it and/or modify it
 *  under the terms of the GNU General Public License version 2 as published
 *  by the Free Software Foundation.
 */

#include <linux/init.h>
#include <linux/slab.h>
#include <linux/platform_device.h>

#include "dev-leds-gpio.h"

void __init ath79_register_leds_gpio(int id,
                     unsigned num_leds,
                     struct gpio_led *leds)
{
    struct platform_device *pdev;
    struct gpio_led_platform_data pdata;
    struct gpio_led *p;
    int err;

    p = kmemdup(leds, num_leds * sizeof(*p), GFP_KERNEL);
    if (!p)
        return;

    pdev = platform_device_alloc("leds-gpio", id);
    if (!pdev)
        goto err_free_leds;

    memset(&pdata, 0, sizeof(pdata));
    pdata.num_leds = num_leds;
    pdata.leds = p;

    err = platform_device_add_data(pdev, &pdata, sizeof(pdata));
    if (err)
        goto err_put_pdev;

    err = platform_device_add(pdev);
    if (err)
        goto err_put_pdev;

    return;

err_put_pdev:
    platform_device_put(pdev);

err_free_leds:
    kfree(p);
}