mirror of
https://github.com/reactos/reactos.git
synced 2024-06-29 17:31:31 +00:00
70 lines
1.7 KiB
C
70 lines
1.7 KiB
C
/*
|
|
* PROJECT: ReactOS Boot Loader
|
|
* LICENSE: BSD - See COPYING.ARM in the top level directory
|
|
* FILE: boot/armllb/hw/omap3-zoom2/hwtwl40x.c
|
|
* PURPOSE: LLB Synpatics Keypad Support for OMAP3 ZOOM 2
|
|
* PROGRAMMERS: ReactOS Portable Systems Group
|
|
*/
|
|
|
|
#include "precomp.h"
|
|
|
|
/* FUNCTIONS ******************************************************************/
|
|
|
|
UCHAR
|
|
NTAPI
|
|
LlbHwOmap3TwlRead1(IN UCHAR ChipAddress,
|
|
IN UCHAR RegisterAddress)
|
|
{
|
|
volatile int i = 1000;
|
|
|
|
/* Select the register */
|
|
LlbHwOmap3TwlWrite(ChipAddress, RegisterAddress, 0, NULL);
|
|
|
|
/* Now read it */
|
|
WRITE_REGISTER_USHORT(0x48070024, 0x8401);
|
|
for (i = 1000; i > 0; i--);
|
|
return READ_REGISTER_USHORT(0x4807001c);
|
|
}
|
|
|
|
VOID
|
|
NTAPI
|
|
LlbHwOmap3TwlWrite(IN UCHAR ChipAddress,
|
|
IN UCHAR RegisterAddress,
|
|
IN UCHAR Length,
|
|
IN PUCHAR Values)
|
|
{
|
|
volatile int i = 1000;
|
|
ULONG j;
|
|
|
|
/* Select chip address */
|
|
WRITE_REGISTER_USHORT(0x4807002c, ChipAddress);
|
|
WRITE_REGISTER_USHORT(0x48070018, Length + 1);
|
|
|
|
/* Enable master transmit mode */
|
|
WRITE_REGISTER_USHORT(0x48070024, 0x8601);
|
|
WRITE_REGISTER_USHORT(0x4807001c, RegisterAddress);
|
|
|
|
/* Loop each byte */
|
|
for (j = 0; j < Length; j++)
|
|
{
|
|
/* Write the data */
|
|
WRITE_REGISTER_USHORT(0x4807001c, Values[j]);
|
|
}
|
|
|
|
/* Issue stop command */
|
|
WRITE_REGISTER_USHORT(0x48070024, 0x8602);
|
|
for (i = 1000; i > 0; i--);
|
|
}
|
|
|
|
VOID
|
|
NTAPI
|
|
LlbHwOmap3TwlWrite1(IN UCHAR ChipAddress,
|
|
IN UCHAR RegisterAddress,
|
|
IN UCHAR Value)
|
|
{
|
|
/* Do the actual write */
|
|
LlbHwOmap3TwlWrite(ChipAddress, RegisterAddress, 1, &Value);
|
|
}
|
|
|
|
/* EOF */
|