Add initial source
This commit is contained in:
1
.gitignore
vendored
Normal file
1
.gitignore
vendored
Normal file
@ -0,0 +1 @@
|
|||||||
|
/build/
|
21
Makefile
Normal file
21
Makefile
Normal file
@ -0,0 +1,21 @@
|
|||||||
|
SRC=$(wildcard src/*.c)
|
||||||
|
INCLUDE=$(wildcard src/include/*.h)
|
||||||
|
OBJ=$(patsubst src/%.c,build/%.rel,$(SRC))
|
||||||
|
|
||||||
|
all: build/ec.rom
|
||||||
|
|
||||||
|
clean:
|
||||||
|
rm -rf build
|
||||||
|
|
||||||
|
build/ec.rom: build/ec.ihx
|
||||||
|
mkdir -p build
|
||||||
|
makebin -p < $< > $@
|
||||||
|
|
||||||
|
build/ec.ihx: $(OBJ)
|
||||||
|
mkdir -p build
|
||||||
|
sdcc -mmcs51 -o $@ $<
|
||||||
|
|
||||||
|
build/%.rel: src/%.c $(INCLUDE)
|
||||||
|
mkdir -p build
|
||||||
|
cd build && \
|
||||||
|
sdcc -mmcs51 -c ../$<
|
8
src/include/gctrl.h
Normal file
8
src/include/gctrl.h
Normal file
@ -0,0 +1,8 @@
|
|||||||
|
#ifndef _GCTRL_H_
|
||||||
|
#define _GCTRL_H_
|
||||||
|
|
||||||
|
__xdata volatile unsigned char __at(0x2006) RSTS;
|
||||||
|
__xdata volatile unsigned char __at(0x200A) BADRSEL;
|
||||||
|
__xdata volatile unsigned char __at(0x200D) SPCTRL1;
|
||||||
|
|
||||||
|
#endif // _GCTRL_H_
|
140
src/include/gpio.h
Normal file
140
src/include/gpio.h
Normal file
@ -0,0 +1,140 @@
|
|||||||
|
#ifndef _GPIO_H_
|
||||||
|
#define _GPIO_H_
|
||||||
|
|
||||||
|
__xdata volatile unsigned char __at(0x1600) GCR;
|
||||||
|
|
||||||
|
__xdata volatile unsigned char __at(0x1601) GPDRA;
|
||||||
|
__xdata volatile unsigned char __at(0x1602) GPDRB;
|
||||||
|
__xdata volatile unsigned char __at(0x1603) GPDRC;
|
||||||
|
__xdata volatile unsigned char __at(0x1604) GPDRD;
|
||||||
|
__xdata volatile unsigned char __at(0x1605) GPDRE;
|
||||||
|
__xdata volatile unsigned char __at(0x1606) GPDRF;
|
||||||
|
__xdata volatile unsigned char __at(0x1607) GPDRG;
|
||||||
|
__xdata volatile unsigned char __at(0x1608) GPDRH;
|
||||||
|
__xdata volatile unsigned char __at(0x1609) GPDRI;
|
||||||
|
__xdata volatile unsigned char __at(0x160A) GPDRJ;
|
||||||
|
__xdata volatile unsigned char __at(0x160D) GPDRM;
|
||||||
|
|
||||||
|
__xdata volatile unsigned char __at(0x1661) GPDMRA;
|
||||||
|
__xdata volatile unsigned char __at(0x1662) GPDMRB;
|
||||||
|
__xdata volatile unsigned char __at(0x1663) GPDMRC;
|
||||||
|
__xdata volatile unsigned char __at(0x1664) GPDMRD;
|
||||||
|
__xdata volatile unsigned char __at(0x1665) GPDMRE;
|
||||||
|
__xdata volatile unsigned char __at(0x1666) GPDMRF;
|
||||||
|
__xdata volatile unsigned char __at(0x1667) GPDMRG;
|
||||||
|
__xdata volatile unsigned char __at(0x1668) GPDMRH;
|
||||||
|
__xdata volatile unsigned char __at(0x1669) GPDMRI;
|
||||||
|
__xdata volatile unsigned char __at(0x166A) GPDMRJ;
|
||||||
|
__xdata volatile unsigned char __at(0x166D) GPDMRM;
|
||||||
|
|
||||||
|
__xdata volatile unsigned char __at(0x1671) GPOTA;
|
||||||
|
__xdata volatile unsigned char __at(0x1672) GPOTB;
|
||||||
|
__xdata volatile unsigned char __at(0x1673) GPOTC;
|
||||||
|
__xdata volatile unsigned char __at(0x1674) GPOTD;
|
||||||
|
__xdata volatile unsigned char __at(0x1675) GPOTE;
|
||||||
|
__xdata volatile unsigned char __at(0x1676) GPOTF;
|
||||||
|
__xdata volatile unsigned char __at(0x1677) GPOTG;
|
||||||
|
__xdata volatile unsigned char __at(0x1678) GPOTH;
|
||||||
|
__xdata volatile unsigned char __at(0x1679) GPOTI;
|
||||||
|
__xdata volatile unsigned char __at(0x167A) GPOTJ;
|
||||||
|
// GPOTM does not exist
|
||||||
|
|
||||||
|
__xdata volatile unsigned char __at(0x1610) GPCRA0;
|
||||||
|
__xdata volatile unsigned char __at(0x1611) GPCRA1;
|
||||||
|
__xdata volatile unsigned char __at(0x1612) GPCRA2;
|
||||||
|
__xdata volatile unsigned char __at(0x1613) GPCRA3;
|
||||||
|
__xdata volatile unsigned char __at(0x1614) GPCRA4;
|
||||||
|
__xdata volatile unsigned char __at(0x1615) GPCRA5;
|
||||||
|
__xdata volatile unsigned char __at(0x1616) GPCRA6;
|
||||||
|
__xdata volatile unsigned char __at(0x1617) GPCRA7;
|
||||||
|
|
||||||
|
__xdata volatile unsigned char __at(0x1618) GPCRB0;
|
||||||
|
__xdata volatile unsigned char __at(0x1619) GPCRB1;
|
||||||
|
__xdata volatile unsigned char __at(0x161A) GPCRB2;
|
||||||
|
__xdata volatile unsigned char __at(0x161B) GPCRB3;
|
||||||
|
__xdata volatile unsigned char __at(0x161C) GPCRB4;
|
||||||
|
__xdata volatile unsigned char __at(0x161D) GPCRB5;
|
||||||
|
__xdata volatile unsigned char __at(0x161E) GPCRB6;
|
||||||
|
__xdata volatile unsigned char __at(0x161F) GPCRB7;
|
||||||
|
|
||||||
|
__xdata volatile unsigned char __at(0x1620) GPCRC0;
|
||||||
|
__xdata volatile unsigned char __at(0x1621) GPCRC1;
|
||||||
|
__xdata volatile unsigned char __at(0x1622) GPCRC2;
|
||||||
|
__xdata volatile unsigned char __at(0x1623) GPCRC3;
|
||||||
|
__xdata volatile unsigned char __at(0x1624) GPCRC4;
|
||||||
|
__xdata volatile unsigned char __at(0x1625) GPCRC5;
|
||||||
|
__xdata volatile unsigned char __at(0x1626) GPCRC6;
|
||||||
|
__xdata volatile unsigned char __at(0x1627) GPCRC7;
|
||||||
|
|
||||||
|
__xdata volatile unsigned char __at(0x1628) GPCRD0;
|
||||||
|
__xdata volatile unsigned char __at(0x1629) GPCRD1;
|
||||||
|
__xdata volatile unsigned char __at(0x162A) GPCRD2;
|
||||||
|
__xdata volatile unsigned char __at(0x162B) GPCRD3;
|
||||||
|
__xdata volatile unsigned char __at(0x162C) GPCRD4;
|
||||||
|
__xdata volatile unsigned char __at(0x162D) GPCRD5;
|
||||||
|
__xdata volatile unsigned char __at(0x162E) GPCRD6;
|
||||||
|
__xdata volatile unsigned char __at(0x162F) GPCRD7;
|
||||||
|
|
||||||
|
__xdata volatile unsigned char __at(0x1630) GPCRE0;
|
||||||
|
__xdata volatile unsigned char __at(0x1631) GPCRE1;
|
||||||
|
__xdata volatile unsigned char __at(0x1632) GPCRE2;
|
||||||
|
__xdata volatile unsigned char __at(0x1633) GPCRE3;
|
||||||
|
__xdata volatile unsigned char __at(0x1634) GPCRE4;
|
||||||
|
__xdata volatile unsigned char __at(0x1635) GPCRE5;
|
||||||
|
__xdata volatile unsigned char __at(0x1636) GPCRE6;
|
||||||
|
__xdata volatile unsigned char __at(0x1637) GPCRE7;
|
||||||
|
|
||||||
|
__xdata volatile unsigned char __at(0x1638) GPCRF0;
|
||||||
|
__xdata volatile unsigned char __at(0x1639) GPCRF1;
|
||||||
|
__xdata volatile unsigned char __at(0x163A) GPCRF2;
|
||||||
|
__xdata volatile unsigned char __at(0x163B) GPCRF3;
|
||||||
|
__xdata volatile unsigned char __at(0x163C) GPCRF4;
|
||||||
|
__xdata volatile unsigned char __at(0x163D) GPCRF5;
|
||||||
|
__xdata volatile unsigned char __at(0x163E) GPCRF6;
|
||||||
|
__xdata volatile unsigned char __at(0x163F) GPCRF7;
|
||||||
|
|
||||||
|
__xdata volatile unsigned char __at(0x1640) GPCRG0;
|
||||||
|
__xdata volatile unsigned char __at(0x1641) GPCRG1;
|
||||||
|
__xdata volatile unsigned char __at(0x1642) GPCRG2;
|
||||||
|
__xdata volatile unsigned char __at(0x1643) GPCRG3;
|
||||||
|
__xdata volatile unsigned char __at(0x1644) GPCRG4;
|
||||||
|
__xdata volatile unsigned char __at(0x1645) GPCRG5;
|
||||||
|
__xdata volatile unsigned char __at(0x1646) GPCRG6;
|
||||||
|
__xdata volatile unsigned char __at(0x1647) GPCRG7;
|
||||||
|
|
||||||
|
__xdata volatile unsigned char __at(0x1648) GPCRH0;
|
||||||
|
__xdata volatile unsigned char __at(0x1649) GPCRH1;
|
||||||
|
__xdata volatile unsigned char __at(0x164A) GPCRH2;
|
||||||
|
__xdata volatile unsigned char __at(0x164B) GPCRH3;
|
||||||
|
__xdata volatile unsigned char __at(0x164C) GPCRH4;
|
||||||
|
__xdata volatile unsigned char __at(0x164D) GPCRH5;
|
||||||
|
__xdata volatile unsigned char __at(0x164E) GPCRH6;
|
||||||
|
__xdata volatile unsigned char __at(0x164F) GPCRH7;
|
||||||
|
|
||||||
|
__xdata volatile unsigned char __at(0x1650) GPCRI0;
|
||||||
|
__xdata volatile unsigned char __at(0x1651) GPCRI1;
|
||||||
|
__xdata volatile unsigned char __at(0x1652) GPCRI2;
|
||||||
|
__xdata volatile unsigned char __at(0x1653) GPCRI3;
|
||||||
|
__xdata volatile unsigned char __at(0x1654) GPCRI4;
|
||||||
|
__xdata volatile unsigned char __at(0x1655) GPCRI5;
|
||||||
|
__xdata volatile unsigned char __at(0x1656) GPCRI6;
|
||||||
|
__xdata volatile unsigned char __at(0x1657) GPCRI7;
|
||||||
|
|
||||||
|
__xdata volatile unsigned char __at(0x1658) GPCRJ0;
|
||||||
|
__xdata volatile unsigned char __at(0x1659) GPCRJ1;
|
||||||
|
__xdata volatile unsigned char __at(0x165A) GPCRJ2;
|
||||||
|
__xdata volatile unsigned char __at(0x165B) GPCRJ3;
|
||||||
|
__xdata volatile unsigned char __at(0x165C) GPCRJ4;
|
||||||
|
__xdata volatile unsigned char __at(0x165D) GPCRJ5;
|
||||||
|
__xdata volatile unsigned char __at(0x165E) GPCRJ6;
|
||||||
|
__xdata volatile unsigned char __at(0x165F) GPCRJ7;
|
||||||
|
|
||||||
|
__xdata volatile unsigned char __at(0x16A0) GPCRM0;
|
||||||
|
__xdata volatile unsigned char __at(0x16A1) GPCRM1;
|
||||||
|
__xdata volatile unsigned char __at(0x16A2) GPCRM2;
|
||||||
|
__xdata volatile unsigned char __at(0x16A3) GPCRM3;
|
||||||
|
__xdata volatile unsigned char __at(0x16A4) GPCRM4;
|
||||||
|
__xdata volatile unsigned char __at(0x16A5) GPCRM5;
|
||||||
|
__xdata volatile unsigned char __at(0x16A6) GPCRM6;
|
||||||
|
|
||||||
|
#endif // _GPIO_H_
|
11
src/include/kbc.h
Normal file
11
src/include/kbc.h
Normal file
@ -0,0 +1,11 @@
|
|||||||
|
#ifndef _KBC_H_
|
||||||
|
#define _KBC_H_
|
||||||
|
|
||||||
|
__xdata volatile unsigned char __at(0x1300) KBHICR;
|
||||||
|
__xdata volatile unsigned char __at(0x1302) KBIRQR;
|
||||||
|
__xdata volatile unsigned char __at(0x1304) KBHISR;
|
||||||
|
__xdata volatile unsigned char __at(0x1306) KBHIKDOR;
|
||||||
|
__xdata volatile unsigned char __at(0x1308) KBHIMDOR;
|
||||||
|
__xdata volatile unsigned char __at(0x130A) KBHIDIR;
|
||||||
|
|
||||||
|
#endif // _KBC_H_
|
45
src/include/kbscan.h
Normal file
45
src/include/kbscan.h
Normal file
@ -0,0 +1,45 @@
|
|||||||
|
#ifndef _KBSCAN_H_
|
||||||
|
#define _KBSCAN_H_
|
||||||
|
|
||||||
|
__xdata volatile unsigned char __at(0x1D00) KSOL;
|
||||||
|
__xdata volatile unsigned char __at(0x1D01) KSOH1;
|
||||||
|
__xdata volatile unsigned char __at(0x1D02) KSOCTRL;
|
||||||
|
__xdata volatile unsigned char __at(0x1D03) KSOH2;
|
||||||
|
__xdata volatile unsigned char __at(0x1D04) KSI;
|
||||||
|
__xdata volatile unsigned char __at(0x1D05) KSICTRLR;
|
||||||
|
__xdata volatile unsigned char __at(0x1D06) KSIGCTRL;
|
||||||
|
__xdata volatile unsigned char __at(0x1D07) KSIGOEN;
|
||||||
|
__xdata volatile unsigned char __at(0x1D08) KSIGDAT;
|
||||||
|
__xdata volatile unsigned char __at(0x1D09) KSIGDMRR;
|
||||||
|
__xdata volatile unsigned char __at(0x1D0A) KSOHGCTRL;
|
||||||
|
__xdata volatile unsigned char __at(0x1D0B) KSOHGOEN;
|
||||||
|
__xdata volatile unsigned char __at(0x1D0C) KSOHGDMRR;
|
||||||
|
__xdata volatile unsigned char __at(0x1D0D) KSOLGCTRL;
|
||||||
|
__xdata volatile unsigned char __at(0x1D0E) KSOLGOEN;
|
||||||
|
__xdata volatile unsigned char __at(0x1D0F) KSOLGDMRR;
|
||||||
|
|
||||||
|
__xdata volatile unsigned char __at(0x1D10) KSO0LSDR;
|
||||||
|
__xdata volatile unsigned char __at(0x1D11) KSO1LSDR;
|
||||||
|
__xdata volatile unsigned char __at(0x1D12) KSO2LSDR;
|
||||||
|
__xdata volatile unsigned char __at(0x1D13) KSO3LSDR;
|
||||||
|
__xdata volatile unsigned char __at(0x1D14) KSO4LSDR;
|
||||||
|
__xdata volatile unsigned char __at(0x1D15) KSO5LSDR;
|
||||||
|
__xdata volatile unsigned char __at(0x1D16) KSO6LSDR;
|
||||||
|
__xdata volatile unsigned char __at(0x1D17) KSO7LSDR;
|
||||||
|
__xdata volatile unsigned char __at(0x1D18) KSO8LSDR;
|
||||||
|
__xdata volatile unsigned char __at(0x1D19) KSO9LSDR;
|
||||||
|
__xdata volatile unsigned char __at(0x1D1A) KSO10LSDR;
|
||||||
|
__xdata volatile unsigned char __at(0x1D1B) KSO11LSDR;
|
||||||
|
__xdata volatile unsigned char __at(0x1D1C) KSO12LSDR;
|
||||||
|
__xdata volatile unsigned char __at(0x1D1D) KSO13LSDR;
|
||||||
|
__xdata volatile unsigned char __at(0x1D1E) KSO14LSDR;
|
||||||
|
__xdata volatile unsigned char __at(0x1D1F) KSO15LSDR;
|
||||||
|
__xdata volatile unsigned char __at(0x1D20) KSO16LSDR;
|
||||||
|
__xdata volatile unsigned char __at(0x1D21) KSO17LSDR;
|
||||||
|
|
||||||
|
__xdata volatile unsigned char __at(0x1D22) SDC1R;
|
||||||
|
__xdata volatile unsigned char __at(0x1D23) SDC2R;
|
||||||
|
__xdata volatile unsigned char __at(0x1D24) SDC3R;
|
||||||
|
__xdata volatile unsigned char __at(0x1D25) SDSR;
|
||||||
|
|
||||||
|
#endif // _KBSCAN_H_
|
7
src/include/pmc.h
Normal file
7
src/include/pmc.h
Normal file
@ -0,0 +1,7 @@
|
|||||||
|
#ifndef _PMC_H_
|
||||||
|
#define _PMC_H_
|
||||||
|
|
||||||
|
__xdata volatile unsigned char __at(0x1506) PM1CTL;
|
||||||
|
__xdata volatile unsigned char __at(0x1516) PM2CTL;
|
||||||
|
|
||||||
|
#endif // _PMC_H_
|
20
src/include/ps2.h
Normal file
20
src/include/ps2.h
Normal file
@ -0,0 +1,20 @@
|
|||||||
|
#ifndef _PS2_H_
|
||||||
|
#define _PS2_H_
|
||||||
|
|
||||||
|
__xdata volatile unsigned char __at(0x1700) PSCTL1;
|
||||||
|
__xdata volatile unsigned char __at(0x1701) PSCTL2;
|
||||||
|
__xdata volatile unsigned char __at(0x1702) PSCTL3;
|
||||||
|
|
||||||
|
__xdata volatile unsigned char __at(0x1704) PSINT1;
|
||||||
|
__xdata volatile unsigned char __at(0x1705) PSINT2;
|
||||||
|
__xdata volatile unsigned char __at(0x1706) PSINT3;
|
||||||
|
|
||||||
|
__xdata volatile unsigned char __at(0x1708) PSSTS1;
|
||||||
|
__xdata volatile unsigned char __at(0x1709) PSSTS2;
|
||||||
|
__xdata volatile unsigned char __at(0x170A) PSSTS3;
|
||||||
|
|
||||||
|
__xdata volatile unsigned char __at(0x170C) PSDAT1;
|
||||||
|
__xdata volatile unsigned char __at(0x170D) PSDAT2;
|
||||||
|
__xdata volatile unsigned char __at(0x170E) PSDAT3;
|
||||||
|
|
||||||
|
#endif // _PS2_H_
|
12
src/include/signature.h
Normal file
12
src/include/signature.h
Normal file
@ -0,0 +1,12 @@
|
|||||||
|
#ifndef _SIGNATURE_H_
|
||||||
|
#define _SIGNATURE_H_
|
||||||
|
|
||||||
|
static __code char __at(0x40) SIGNATURE[32] = {
|
||||||
|
0xA5, 0xA5, 0xA5, 0xA5, 0xA5, 0xA5, 0xA5, 0x94,
|
||||||
|
0x85, 0x12, 0x5A, 0x5A, 0xAA, 0x00, 0x55, 0x55,
|
||||||
|
|
||||||
|
0x49, 0x54, 0x45, 0x20, 0x54, 0x65, 0x63, 0x68,
|
||||||
|
0x2E, 0x20, 0x49, 0x6E, 0x63, 0x2E, 0x20, 0x20
|
||||||
|
};
|
||||||
|
|
||||||
|
#endif // _SIGNATURE_H_
|
280
src/main.c
Normal file
280
src/main.c
Normal file
@ -0,0 +1,280 @@
|
|||||||
|
#include "include/signature.h"
|
||||||
|
|
||||||
|
void reset() {
|
||||||
|
__asm__("ljmp 0");
|
||||||
|
}
|
||||||
|
|
||||||
|
#include "include/gpio.h"
|
||||||
|
|
||||||
|
void gpio_init() {
|
||||||
|
// Enable LPC reset on GPD2
|
||||||
|
GCR = 0x04;
|
||||||
|
|
||||||
|
// Set GPIO data
|
||||||
|
GPDRA = 0;
|
||||||
|
GPDRB = (1 << 0);
|
||||||
|
GPDRC = 0;
|
||||||
|
GPDRD = (1 << 5) | (1 << 4) | (1 << 3);
|
||||||
|
GPDRE = 0;
|
||||||
|
GPDRF = (1 << 7) | (1 << 6);
|
||||||
|
GPDRG = 0;
|
||||||
|
GPDRH = 0;
|
||||||
|
GPDRI = 0;
|
||||||
|
GPDRJ = 0;
|
||||||
|
|
||||||
|
// Set GPIO control
|
||||||
|
GPCRA0 = 0x80;
|
||||||
|
GPCRA1 = 0x00;
|
||||||
|
GPCRA2 = 0x00;
|
||||||
|
GPCRA3 = 0x80;
|
||||||
|
GPCRA4 = 0x40;
|
||||||
|
GPCRA5 = 0x44;
|
||||||
|
GPCRA6 = 0x44;
|
||||||
|
GPCRA7 = 0x44;
|
||||||
|
GPCRB0 = 0x44;
|
||||||
|
GPCRB1 = 0x44;
|
||||||
|
GPCRB2 = 0x84;
|
||||||
|
GPCRB3 = 0x00;
|
||||||
|
GPCRB4 = 0x00;
|
||||||
|
GPCRB5 = 0x44;
|
||||||
|
GPCRB6 = 0x84;
|
||||||
|
GPCRB7 = 0x80;
|
||||||
|
GPCRC0 = 0x80;
|
||||||
|
GPCRC1 = 0x84;
|
||||||
|
GPCRC2 = 0x84;
|
||||||
|
GPCRC3 = 0x84;
|
||||||
|
GPCRC4 = 0x44;
|
||||||
|
GPCRC5 = 0x44;
|
||||||
|
GPCRC6 = 0x40;
|
||||||
|
GPCRC7 = 0x44;
|
||||||
|
GPCRD0 = 0x84;
|
||||||
|
GPCRD1 = 0x84;
|
||||||
|
GPCRD2 = 0x00;
|
||||||
|
GPCRD3 = 0x80;
|
||||||
|
GPCRD4 = 0x80;
|
||||||
|
GPCRD5 = 0x44;
|
||||||
|
GPCRD6 = 0x80;
|
||||||
|
GPCRD7 = 0x80;
|
||||||
|
GPCRE0 = 0x44;
|
||||||
|
GPCRE1 = 0x44;
|
||||||
|
GPCRE2 = 0x80;
|
||||||
|
GPCRE3 = 0x40;
|
||||||
|
GPCRE4 = 0x42;
|
||||||
|
GPCRE5 = 0x40;
|
||||||
|
GPCRE6 = 0x44;
|
||||||
|
GPCRE7 = 0x44;
|
||||||
|
GPCRF0 = 0x80;
|
||||||
|
GPCRF1 = 0x44;
|
||||||
|
GPCRF2 = 0x84;
|
||||||
|
GPCRF3 = 0x44;
|
||||||
|
GPCRF4 = 0x80;
|
||||||
|
GPCRF5 = 0x80;
|
||||||
|
GPCRF6 = 0x00;
|
||||||
|
GPCRF7 = 0x80;
|
||||||
|
GPCRG0 = 0x44;
|
||||||
|
GPCRG1 = 0x44;
|
||||||
|
GPCRG2 = 0x40;
|
||||||
|
GPCRG3 = 0x00;
|
||||||
|
GPCRG4 = 0x00;
|
||||||
|
GPCRG5 = 0x00;
|
||||||
|
GPCRG6 = 0x44;
|
||||||
|
GPCRG7 = 0x00;
|
||||||
|
GPCRH0 = 0x00;
|
||||||
|
GPCRH1 = 0x80;
|
||||||
|
GPCRH2 = 0x44;
|
||||||
|
GPCRH3 = 0x44;
|
||||||
|
GPCRH4 = 0x80;
|
||||||
|
GPCRH5 = 0x80;
|
||||||
|
GPCRH6 = 0x80;
|
||||||
|
GPCRH7 = 0x80;
|
||||||
|
GPCRI0 = 0x00;
|
||||||
|
GPCRI1 = 0x00;
|
||||||
|
GPCRI2 = 0x80;
|
||||||
|
GPCRI3 = 0x00;
|
||||||
|
GPCRI4 = 0x00;
|
||||||
|
GPCRI5 = 0x80;
|
||||||
|
GPCRI6 = 0x80;
|
||||||
|
GPCRI7 = 0x80;
|
||||||
|
GPCRJ0 = 0x82;
|
||||||
|
GPCRJ1 = 0x80;
|
||||||
|
GPCRJ2 = 0x40;
|
||||||
|
GPCRJ3 = 0x80;
|
||||||
|
GPCRJ4 = 0x44;
|
||||||
|
GPCRJ5 = 0x40;
|
||||||
|
GPCRJ6 = 0x44;
|
||||||
|
GPCRJ7 = 0x80;
|
||||||
|
}
|
||||||
|
|
||||||
|
#include "include/gctrl.h"
|
||||||
|
|
||||||
|
void gctrl_init() {
|
||||||
|
SPCTRL1 = 0x03;
|
||||||
|
BADRSEL = 0;
|
||||||
|
RSTS = 0x84;
|
||||||
|
}
|
||||||
|
|
||||||
|
#include "include/kbc.h"
|
||||||
|
|
||||||
|
void kbc_init() {
|
||||||
|
KBIRQR = 0;
|
||||||
|
KBHICR = 0x48;
|
||||||
|
}
|
||||||
|
|
||||||
|
#include "include/pmc.h"
|
||||||
|
|
||||||
|
void pmc_init() {
|
||||||
|
PM1CTL = 0x41;
|
||||||
|
PM2CTL = 0x41;
|
||||||
|
}
|
||||||
|
|
||||||
|
#include "include/ps2.h"
|
||||||
|
|
||||||
|
void ps2_init() {
|
||||||
|
PSCTL1 = 0x11;
|
||||||
|
PSCTL2 = 0x41;
|
||||||
|
PSCTL3 = 0x41;
|
||||||
|
PSINT1 = 0x04;
|
||||||
|
PSINT2 = 0x04;
|
||||||
|
PSINT3 = 0x04;
|
||||||
|
}
|
||||||
|
|
||||||
|
#include "include/kbscan.h"
|
||||||
|
|
||||||
|
void kbscan_init() {
|
||||||
|
KSOCTRL = 0x05;
|
||||||
|
KSICTRLR = 0x04;
|
||||||
|
|
||||||
|
// Set all outputs to GPIO mode and high
|
||||||
|
KSOH2 = 0xFF;
|
||||||
|
KSOH1 = 0xFF;
|
||||||
|
KSOL = 0xFF;
|
||||||
|
KSOHGCTRL = 0xFF;
|
||||||
|
KSOHGOEN = 0xFF;
|
||||||
|
KSOLGCTRL = 0xFF;
|
||||||
|
KSOLGOEN = 0xFF;
|
||||||
|
}
|
||||||
|
|
||||||
|
#include <8051.h>
|
||||||
|
|
||||||
|
void timer_clear(void) {
|
||||||
|
TR0 = 0;
|
||||||
|
TF0 = 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
void timer_mode_1(int value) {
|
||||||
|
timer_clear();
|
||||||
|
TMOD = 0x01;
|
||||||
|
TH0 = (unsigned char)(value >> 8);
|
||||||
|
TL0 = (unsigned char)value;
|
||||||
|
TR0 = 1;
|
||||||
|
}
|
||||||
|
|
||||||
|
void delay_ms(int ms) {
|
||||||
|
for (int i = 0; i < ms; i++) {
|
||||||
|
// One millisecond in ticks is determined as follows:
|
||||||
|
// 9.2 MHz is the clock rate
|
||||||
|
// The timer divider is 12
|
||||||
|
// The timer rate is 12 / 9.2 MHz = 1.304 us
|
||||||
|
// The ticks are 1000 ms / (1.304 us) = 766.667
|
||||||
|
// 65536 - 766.667 = 64769.33
|
||||||
|
timer_mode_1(64769);
|
||||||
|
while (TF0 == 0) {}
|
||||||
|
timer_clear();
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
#include <stdbool.h>
|
||||||
|
|
||||||
|
struct Pin {
|
||||||
|
__xdata volatile unsigned char * data;
|
||||||
|
__xdata volatile unsigned char * mirror;
|
||||||
|
__xdata volatile unsigned char * control;
|
||||||
|
unsigned char value;
|
||||||
|
};
|
||||||
|
|
||||||
|
#define PIN(BLOCK, NUMBER) { \
|
||||||
|
.data = &GPDR ## BLOCK, \
|
||||||
|
.mirror = &GPDMR ## BLOCK, \
|
||||||
|
.control = &GPCR ## BLOCK ## NUMBER, \
|
||||||
|
.value = (1 << NUMBER), \
|
||||||
|
}
|
||||||
|
|
||||||
|
bool pin_get(struct Pin * pin) {
|
||||||
|
if (*(pin->data) & pin->value) {
|
||||||
|
return true;
|
||||||
|
} else {
|
||||||
|
return false;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
void pin_set(struct Pin * pin, bool value) {
|
||||||
|
if (value) {
|
||||||
|
*(pin->data) |= pin->value;
|
||||||
|
} else {
|
||||||
|
*(pin->data) &= ~(pin->value);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
struct Pin LED_BAT_CHG = PIN(A, 5);
|
||||||
|
struct Pin LED_BAT_FULL = PIN(A, 6);
|
||||||
|
struct Pin LED_PWR = PIN(A, 7);
|
||||||
|
struct Pin LED_ACIN = PIN(C, 7);
|
||||||
|
struct Pin LED_AIRPLANE_N = PIN(G, 6);
|
||||||
|
|
||||||
|
struct Pin PWR_SW = PIN(D, 0);
|
||||||
|
|
||||||
|
void parallel_write(unsigned char value) {
|
||||||
|
// Make sure clock is high
|
||||||
|
KSOH1 = 0xFF;
|
||||||
|
delay_ms(1);
|
||||||
|
|
||||||
|
// Set value
|
||||||
|
KSOL = value;
|
||||||
|
delay_ms(1);
|
||||||
|
|
||||||
|
// Set clock low
|
||||||
|
KSOH1 = 0;
|
||||||
|
pin_set(&LED_ACIN, true);
|
||||||
|
delay_ms(1);
|
||||||
|
|
||||||
|
// Set clock high again
|
||||||
|
pin_set(&LED_ACIN, false);
|
||||||
|
KSOH1 = 0xFF;
|
||||||
|
}
|
||||||
|
|
||||||
|
void puts(const char * s) {
|
||||||
|
char c;
|
||||||
|
while (c = *(s++)) {
|
||||||
|
parallel_write((unsigned char)c);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
void main() {
|
||||||
|
gpio_init();
|
||||||
|
|
||||||
|
gctrl_init();
|
||||||
|
|
||||||
|
kbc_init();
|
||||||
|
|
||||||
|
pmc_init();
|
||||||
|
|
||||||
|
kbscan_init();
|
||||||
|
|
||||||
|
//TODO: INTC, PECI, PWM, SMBUS
|
||||||
|
|
||||||
|
// Set the battery full LED (to know our firmware is loaded)
|
||||||
|
pin_set(&LED_BAT_CHG, true);
|
||||||
|
delay_ms(1000);
|
||||||
|
pin_set(&LED_BAT_FULL, true);
|
||||||
|
puts("Hello from System76 EC!\n");
|
||||||
|
|
||||||
|
bool last = false;
|
||||||
|
for(;;) {
|
||||||
|
// Check if the power switch goes low
|
||||||
|
bool new = pin_get(&PWR_SW);
|
||||||
|
if (!new && last) {
|
||||||
|
puts("Power Switch\n");
|
||||||
|
}
|
||||||
|
last = new;
|
||||||
|
}
|
||||||
|
}
|
Reference in New Issue
Block a user