android_kernel_xiaomi_sm8350/arch/mn10300/unit-asb2364/leds.c
Akira Takeuchi 368dd5acd1 MN10300: And Panasonic AM34 subarch and implement SMP
Implement the Panasonic MN10300 AM34 CPU subarch and implement SMP support for
MN10300.  Also implement support for the MN2WS0060 processor and the ASB2364
evaluation board which are AM34 based.

Signed-off-by: Akira Takeuchi <takeuchi.akr@jp.panasonic.com>
Signed-off-by: Kiyoshi Owada <owada.kiyoshi@jp.panasonic.com>
Signed-off-by: David Howells <dhowells@redhat.com>
2010-10-27 17:28:55 +01:00

99 lines
2.6 KiB
C

/* leds.c: ASB2364 peripheral 7seg LEDs x4 support
*
* Copyright (C) 2002 Red Hat, Inc. All Rights Reserved.
* Written by David Howells (dhowells@redhat.com)
*
* This program is free software; you can redistribute it and/or
* modify it under the terms of the GNU General Public License
* as published by the Free Software Foundation; either version
* 2 of the License, or (at your option) any later version.
*/
#include <linux/kernel.h>
#include <linux/param.h>
#include <linux/init.h>
#include <asm/io.h>
#include <asm/processor.h>
#include <asm/intctl-regs.h>
#include <asm/rtc-regs.h>
#include <unit/leds.h>
#if MN10300_USE_7SEGLEDS
static const u8 asb2364_led_hex_tbl[16] = {
0x80, 0xf2, 0x48, 0x60, 0x32, 0x24, 0x04, 0xf0,
0x00, 0x20, 0x10, 0x06, 0x8c, 0x42, 0x0c, 0x1c
};
static const u32 asb2364_led_chase_tbl[6] = {
~0x02020202, /* top - segA */
~0x04040404, /* right top - segB */
~0x08080808, /* right bottom - segC */
~0x10101010, /* bottom - segD */
~0x20202020, /* left bottom - segE */
~0x40404040, /* left top - segF */
};
static unsigned asb2364_led_chase;
void peripheral_leds7x4_display_dec(unsigned int val, unsigned int points)
{
u32 leds;
leds = asb2364_led_hex_tbl[(val/1000) % 10];
leds <<= 8;
leds |= asb2364_led_hex_tbl[(val/100) % 10];
leds <<= 8;
leds |= asb2364_led_hex_tbl[(val/10) % 10];
leds <<= 8;
leds |= asb2364_led_hex_tbl[val % 10];
leds |= points^0x01010101;
ASB2364_7SEGLEDS = leds;
}
void peripheral_leds7x4_display_hex(unsigned int val, unsigned int points)
{
u32 leds;
leds = asb2364_led_hex_tbl[(val/1000) % 10];
leds <<= 8;
leds |= asb2364_led_hex_tbl[(val/100) % 10];
leds <<= 8;
leds |= asb2364_led_hex_tbl[(val/10) % 10];
leds <<= 8;
leds |= asb2364_led_hex_tbl[val % 10];
leds |= points^0x01010101;
ASB2364_7SEGLEDS = leds;
}
/* display triple horizontal bar and exception code */
void peripheral_leds_display_exception(enum exception_code code)
{
u32 leds;
leds = asb2364_led_hex_tbl[(code/0x100) % 0x10];
leds <<= 8;
leds |= asb2364_led_hex_tbl[(code/0x10) % 0x10];
leds <<= 8;
leds |= asb2364_led_hex_tbl[code % 0x10];
leds |= 0x6d010101;
ASB2364_7SEGLEDS = leds;
}
void peripheral_leds_led_chase(void)
{
ASB2364_7SEGLEDS = asb2364_led_chase_tbl[asb2364_led_chase];
asb2364_led_chase++;
if (asb2364_led_chase >= 6)
asb2364_led_chase = 0;
}
#else /* MN10300_USE_7SEGLEDS */
void peripheral_leds7x4_display_dec(unsigned int val, unsigned int points) { }
void peripheral_leds7x4_display_hex(unsigned int val, unsigned int points) { }
void peripheral_leds_display_exception(enum exception_code code) { }
void peripheral_leds_led_chase(void) { }
#endif /* MN10300_USE_7SEGLEDS */