diff --git a/firmware/drivers/led.c b/firmware/drivers/led.c index 22583364d5..36a4e4eb87 100644 --- a/firmware/drivers/led.c +++ b/firmware/drivers/led.c @@ -27,15 +27,27 @@ #if (CONFIG_LED == LED_REAL) +#if defined(SAMSUNG_YH920) || defined(SAMSUNG_YH925) + +#define LED_ON GPIO_CLEAR_BITWISE(GPIOF_OUTPUT_VAL, 0x20) +#define LED_OFF GPIO_SET_BITWISE(GPIOF_OUTPUT_VAL, 0x20) + +#else + +#define LED_ON or_b(0x40, &PBDRL) +#define LED_OFF and_b(~0x40, &PBDRL) + +#endif /* SAMSUNG_YH920 || SAMSUNG_YH925 */ + void led(bool on) { if ( on ) { - or_b(0x40, &PBDRL); + LED_ON; } else { - and_b(~0x40, &PBDRL); + LED_OFF; } } diff --git a/firmware/export/config/samsungyh920.h b/firmware/export/config/samsungyh920.h index 4837942eed..8717cb765c 100644 --- a/firmware/export/config/samsungyh920.h +++ b/firmware/export/config/samsungyh920.h @@ -115,6 +115,9 @@ /* We're able to shut off power to the HDD */ /* todo #define HAVE_ATA_POWER_OFF */ +/* Software controlled LED */ +#define CONFIG_LED LED_REAL + /* Define this if you have a software controlled poweroff */ #define HAVE_SW_POWEROFF diff --git a/firmware/export/config/samsungyh925.h b/firmware/export/config/samsungyh925.h index ad04f6c81e..098bfc851d 100644 --- a/firmware/export/config/samsungyh925.h +++ b/firmware/export/config/samsungyh925.h @@ -112,6 +112,9 @@ /* We're able to shut off power to the HDD */ /* todo #define HAVE_ATA_POWER_OFF */ +/* Software controlled LED */ +#define CONFIG_LED LED_REAL + /* Define this if you have a software controlled poweroff */ #define HAVE_SW_POWEROFF