Patch para controlar os leds ethernet do Raspberry Pi

Ao ler de usuários a vontade de poder controlar os leds do próprio Raspberry Pi, me vi também interessado, mas no meu caso em poder desligar todos. Infelizmente desligar todos via software não é possível, pois o led PWR é ligado diretamente na energia.

Controle de leds no Raspberry Pi

De modo normal hoje só é possível controlar o ACT led que é ligado diretamente via gpio no SoC da Broadcom, por meio do sysfs em:
/sys/class/leds/led0

Você pode desativar:

echo none > /sys/class/leds/led0/trigger

Reativar:

echo mmc0 > /sys/class/leds/led0/trigger

Ou controlar o mesmo desativando primeiramente e controlando via brightness:

echo none > /sys/class/leds/led0/trigger
echo 1 > /sys/class/leds/led0/brightness
echo 0 > /sys/class/leds/led0/brightness

Mas por qual motivo você controlaria os leds? Após saber que eu não poderia desligar todos por software uma das possibilidades que pensei é a de usar o led para indicar outras coisas.

O que acontece com os outros leds que não podemos controlar? Eles são ligados diretamente no chip LAN9512, aquele menor que é responsável não só pela ethernet como também pelo usb. Então não poderíamos controlar nada correto? Errado. Ao pesquisar vi alguns usuários dizendo que era impossível, mas eles são sim de certa forma controláveis via driver, algo que já é feito pelo próprio driver do LAN9512 no linux. Mas o que ele faz somente é ativar esses leds, o que queremos aqui é algo mais perto de se controlar os mesmos.

Resolvi então fazer um patch no driver para controlá-los via userland, também no sysfs. Claramente que para usar o patch, será preciso recompilar o kernel( ou driver em questão caso esteja separado ), você pode obter maiores informações aqui.

Após o boot do kernel compilado com o patch, aparecerá o diretório /sys/class/smsc95xx_leds e você poderá controlar via eth_fdx, eth_lnk e eth_spd.

Exemplo:
echo 0 > eth_fdx
echo 1 > eth_fdx

Vídeo:



Apesar do patch permitir o controle dos leds, ele de certa forma não é total, se perceberem no começo do vídeo o led LNK dá uma piscada indicando tráfego na rede, pois as funções dos mesmos ainda estão ligadas à ethernet. Futuramente vou verificar a possibilidade de desvincular essa funções.

Download do patch.

--- smsc95xx.c 2013-11-25 17:31:58.181733581 -0200 +++ smsc95xx.c.mod 2013-11-28 17:49:20.467116853 -0200 @@ -71,6 +71,8 @@ struct usbnet *dev; }; +int smsc95xx_ledctl(struct usbnet *dev); + static bool turbo_mode = true; module_param(turbo_mode, bool, 0644); MODULE_PARM_DESC(turbo_mode, "Enable multiple frames per Rx transaction"); @@ -1013,6 +1015,10 @@ ret = smsc95xx_write_reg(dev, LED_GPIO_CFG, write_buf); check_warn_return(ret, "Failed to write LED_GPIO_CFG: %d\n", ret); + // Init sysfs led controller + + smsc95xx_ledctl(dev); + /* Init Tx */ ret = smsc95xx_write_reg(dev, FLOW, 0); check_warn_return(ret, "Failed to write FLOW: %d\n", ret); @@ -1545,3 +1551,87 @@ MODULE_AUTHOR("Steve Glendinning <steve.glendinning@shawell.net>"); MODULE_DESCRIPTION("SMSC95XX USB 2.0 Ethernet Devices"); MODULE_LICENSE("GPL"); + +/* + * Led control patch + */ + +static struct usbnet *leddev = NULL; + +static ssize_t smsc95xx_store(struct class *cls, struct class_attribute *attr, const char *buf, size_t count); +static ssize_t smsc95xx_show(struct class *cls, struct class_attribute *attr, char *buf); + +static CLASS_ATTR(eth_fdx,S_IWUSR, smsc95xx_show, smsc95xx_store); +static CLASS_ATTR(eth_lnk,S_IWUSR, smsc95xx_show, smsc95xx_store); +static CLASS_ATTR(eth_spd,S_IWUSR, smsc95xx_show, smsc95xx_store); + +int smsc95xx_ledctl(struct usbnet *dev){ + + int ret = 0; + static struct class led_gpio = { + + .name = "smsc95xx_leds", + }; + + if(leddev != NULL) return 0; + + leddev = dev; + + ret = class_register(&led_gpio); + if(ret){ + leddev = NULL; + return ret; + } + + ret += class_create_file(&led_gpio,&class_attr_eth_fdx); + ret += class_create_file(&led_gpio,&class_attr_eth_lnk); + ret += class_create_file(&led_gpio,&class_attr_eth_spd); + + if(ret){ + leddev = NULL; + class_unregister(&led_gpio); + return ret; + } + + return 0; +} + +static ssize_t smsc95xx_show(struct class *cls, struct class_attribute *attr, char *buf){ + +return scnprintf(buf, PAGE_SIZE, "you cant even read"); +} + + +static ssize_t smsc95xx_store(struct class *cls, struct class_attribute *attr, const char *buf, size_t count){ +int ret = 0; +static u32 write_buf = LED_GPIO_CFG_FDX_LED | + LED_GPIO_CFG_LNK_LED | + LED_GPIO_CFG_SPD_LED; + + + if(buf[0] == '0'){ + + switch(attr->attr.name[6]){ + + case 'x': write_buf ^= LED_GPIO_CFG_FDX_LED; break; + case 'k': write_buf ^= LED_GPIO_CFG_LNK_LED; break; + case 'd': write_buf ^= LED_GPIO_CFG_SPD_LED; break; + } + + }else if(buf[0] == '1'){ + + switch(attr->attr.name[6]){ + + case 'x': write_buf |= LED_GPIO_CFG_FDX_LED; break; + case 'k': write_buf |= LED_GPIO_CFG_LNK_LED; break; + case 'd': write_buf |= LED_GPIO_CFG_SPD_LED; break; + } + } + + ret = smsc95xx_write_reg(leddev, LED_GPIO_CFG, write_buf); + + if(ret < 0) netdev_warn(leddev->net,"Failed to write LED_GPIO_CFG: %d\n",ret); + + return 1; +} +