arch/arm/mach-s3c44b0x/driver/led.c

   1 #include <asm/arch/hardware.h>
   2
   3 void s3c44b0x_led_off(int bit)
   4 {
   5         SYSREG_OR_SET(S3C44B0X_PDATE, 1<<(4+bit));
   6 }
   7
   8 void s3c44b0x_led_on(int bit)
   9 {
  10         SYSREG_CLR(S3C44B0X_PDATE, 1<<(4+bit));
  11 }
  12
  13 void s3c44b0x_led_disp(int data)
  14 {
  15         data = (data << 12) >> 8;
  16         data = (~data) & 0x1ff;
  17         SYSREG_AND_SET(S3C44B0X_PDATE, ~data);
  18 }
  19
  20 void s3c44b0x_led_init(void)
  21 {
  22         SYSREG_AND_SET(S3C44B0X_PCONE, 0xffff556b);
  23         SYSREG_SET(S3C44B0X_PUPE, 0x6);
  24         SYSREG_SET(S3C44B0X_PDATE, 0x3f7);
  25         s3c44b0x_led_disp(15);
  26 }
  27
  28