Fix USB.ZC enough to compile.

This commit is contained in:
TomAwezome 2022-12-23 02:11:57 -05:00
parent 9182775637
commit e3f3c7cd09

View file

@ -1,217 +1,207 @@
/*
You can play with this if you are
interested in USB.I'm not planning
on doing USB unless the legacy PS2
keyboard/mouse mode disappears.
There EHCI UHCI in various ICH chips and
others and God knows how many custom packet
formats for different keyboards and mice.Okay,
I suppose if BIOS can make a universal
packet, it is done just one way for
different mice.PS2 is more compatible.
*/
#help_index "USB"
extern I64 sys_num_usb;
extern CUSB sys_usb_devs[USB_NUM];
extern CUSBTD *USBAllocTD();
extern U0 USBFreeTD(CUSBTD *tmptd);
extern U0 USBEndAll();
extern U0 USBInitAll();
extern U32 *USBAllocFrameLst(I64 usb_num, I64 size);
U8 *StatCB(CDoc *, CDocEntry *doc_e, CTask *mem_task)
{
//This routine shows the stat of the USB ports
U8 *st = MAlloc(128, mem_task);
U16 w1, w2, w3, w4;
U32 d1;
CUSB *u = doc_e->user_data;
I64 d = u->ports;
w3 = InU16(d + USBP_STS);
w1 = InU16(d + USBP_PORTSC0);
w2 = InU16(d + USBP_PORTSC1);
w4 = InU16(d + USBP_FRNUM);
d1 = InU32(d + USBP_FRBASEADD);
StrPrint(st, "%X:Stat:%04X P0:%04X P1:%04X FRAME:%04X", d1, w3, w1, w2, w4);
return st;
}
U0 PutStat()
{
I64 i;
CDocEntry *doc_e;
CUSB *u;
WinMax;
"$$FG,GREEN$$Dev Stat Bits\n$$FG$$"
" 0:IRQ\n"
" 1:IRQ err\n"
" 2:Resume\n"
" 3:Host Sys Err\n"
" 4:Host Process Err\n"
" 5:Halted\n"
"$$FG,GREEN$$Port Stat Bits\n$$FG$$"
" 0:Connection Stat\n"
" 1:Connection Stat Change\n"
" 2:Port Enabled\n"
" 3:Port Enabled Change\n"
"4-5:Line Stat\n"
" 6:Resume Detect\n"
" 8:Low Speed\n"
" 9:Port Rst\n"
" 10:Overcurrent Active\n"
" 11:Overcurrent Indicator\n"
" 12:Suspend\n\n";
for (i = 0; i < sys_num_usb; i++)
{
u = &sys_usb_devs[i];
"$$FG,LTRED$$Dev%d:%X:", i, u->ports;
doc_e = DocPrint(DocPut, "$$TX+TC,\" \"$$");
doc_e->user_data = &sys_usb_devs[i];
doc_e->tag_cb = &StatCB;
"$$FG$$\n";
}
NewLine;
}
extern U0 PutQH(U32 h);
U32 *P(U32 d)
{
return d & ~3;
}
U0 PutTD(U32 t)
{
"TD:$$FG,GREEN$$%08X$$FG$$\n", t;
"%08X\n", *P(t);
DocDm(t + 4, 8);
if (*P(t + 12))
DocDm(*P(t + 12), 16);
// DocDm(*P(t+12), *P(t+4) >> 21 & 0x7FF);
if (!(*P(t) & 1))
{
if (*P(t) & 2)
PutQH(*P(t));
else
PutTD(*P(t));
}
}
U0 PutQH(U32 h)
{
"QH:$$FG,RED$$%08X$$FG$$\n", h;
"%08X\n", *P(h);
"%08X\n", *P(h + 4);
if (!(*P(h) & 1))
{
if (*P(h) & 2)
PutQH(*P(h));
else
PutTD(*P(h));
}
if (!(*P(h + 4) & 1))
{
if (*P(h + 4) & 2)
PutQH(*P(h + 4));
else
PutTD(*P(h + 4));
}
}
U0 PutFrame(U32 f)
{
PutQH(f);
}
U0 PutFrames()
{
I64 i, d, f, w1, w2;
CUSB *u;
for (i = 0; i < sys_num_usb; i++)
{
u = &sys_usb_devs[i];
d = u->ports;
w1 = InU16(d + USBP_PORTSC0);
w2 = InU16(d + USBP_PORTSC1);
if (w1 & 1 || w2 & 1)
{
f = InU32(d + USBP_FRBASEADD);
PutFrame(f);
}
}
}
U0 Main()
{
USBInitAll;
PutStat;
PutFrames;
"$$FG,RED$$The BIOS sets-up the USB in PS/2 legacy mode.$$FG$$\n";
}
Main;
/* Not Finished
#define PORT 5
#define DEV_ADD_INIT 1
#define DEV_ADD 1
#define END_PT0 0
#define END_PT1 1
#define END_PT2 2
#define LEN_MAX 8
#define TERMINATE 1
U0 SetUpTD()
{
CUSB *u = &sys_usb_devs[PORT];
I64 i, d = u->ports;
U32 *frm = CAllocAligned(0x1000, 0x1000, Fs->code_heap),
*tds = CAllocAligned(256, 16, Fs->code_heap),
*buf = CAlloc(128, Fs->code_heap);
DocD(buf, 128);
"<0>\n"; Sleep(100);
OutU16(d + USBP_CMD, 2); //Reset
"<1>\n"; Sleep(100);
OutU16(d + USBP_CMD, 0);
"<2>\n"; Sleep(100);
OutU16(d + USBP_PORTSC0, 4); //Enable
OutU16(d + USBP_PORTSC1, 4);
"<3>\n"; Sleep(100);
tds[0] = &tds[4](U8 *);
tds[1] = 0;
tds[2] = PID_SETUP + DEV_ADD_INIT << 8 + END_PT0 << 15 + LEN_MAX << 21;
tds[3] = buf;
buf[0] = 0 + RQ_SET_ADDR << 8 + DEV_ADD << 16;
buf[1] = 0 + 0 << 16;
tds[4] = TERMINATE;
tds[5] = 0;
tds[6] = PID_SETUP + DEV_ADD_INIT << 8 + END_PT0 << 15 + LEN_MAX << 21;
tds[7] = buf(U8 *) + 8;
buf[2] = 0 + RQ_SET_ADDR << 8 + DEV_ADD << 16;
buf[3] = 0 + 0 << 16;
frm[0] = &tds[0](U8 *);
for (i = 1; i < 0x1000 / 4; i++)
frm[i] = TERMINATE;
OutU16(d + USBP_FRNUM, frm);
OutU32(d + USBP_FRBASEADD, frm);
"<4>\n"; Sleep(200);
OutU16(d + USBP_CMD,1);
"<5>\n"; Sleep(1000);
OutU16(d + USBP_CMD,0);
"<6>\n"; Sleep(200);
}
SetUpTD;
*/
#help_index "USB"
extern I64 sys_num_usb;
extern CUSB sys_usb_devs[USB_NUM];
extern CUSBTD *USBAllocTD();
extern U0 USBFreeTD(CUSBTD *tmptd);
extern U0 USBEndAll();
extern U0 USBInitAll();
extern U32 *USBAllocFrameLst(I64 usb_num, I64 size);
U8 *StatCB(CDoc *, CDocEntry *doc_e, CTask *mem_task)
{
//This routine shows the stat of the USB ports
U8 *st = MAlloc(128, mem_task);
U16 w1, w2, w3, w4;
U32 d1;
CUSB *u = doc_e->user_data;
I64 d = u->ports;
w3 = InU16(d + USBP_STS);
w1 = InU16(d + USBP_PORTSC0);
w2 = InU16(d + USBP_PORTSC1);
w4 = InU16(d + USBP_FRNUM);
d1 = InU32(d + USBP_FRBASEADD);
StrPrint(st, "%X:Stat:%04X P0:%04X P1:%04X FRAME:%04X", d1, w3, w1, w2, w4);
return st;
}
U0 PutStat()
{
I64 i;
CDocEntry *doc_e;
CUSB *u;
WinMax;
"$$FG,GREEN$$Dev Stat Bits\n$$FG$$"
" 0:IRQ\n"
" 1:IRQ err\n"
" 2:Resume\n"
" 3:Host Sys Err\n"
" 4:Host Process Err\n"
" 5:Halted\n"
"$$FG,GREEN$$Port Stat Bits\n$$FG$$"
" 0:Connection Stat\n"
" 1:Connection Stat Change\n"
" 2:Port Enabled\n"
" 3:Port Enabled Change\n"
"4-5:Line Stat\n"
" 6:Resume Detect\n"
" 8:Low Speed\n"
" 9:Port Rst\n"
" 10:Overcurrent Active\n"
" 11:Overcurrent Indicator\n"
" 12:Suspend\n\n";
for (i = 0; i < sys_num_usb; i++)
{
u = &sys_usb_devs[i];
"$$FG,LTRED$$Dev%d:%X:", i, u->ports;
doc_e = DocPrint(DocPut, "$$TX+TC,\" \"$$");
doc_e->user_data = &sys_usb_devs[i];
doc_e->tag_cb = &StatCB;
"$$FG$$\n";
}
// NewLine;
"\n";
}
extern U0 PutQH(U32 h);
U32 *P(U32 d)
{
return d & ~3;
}
U0 PutTD(U32 t)
{
"TD:$$FG,GREEN$$%08X$$FG$$\n", t;
"%08X\n", *P(t);
DocDumpMem(t + 4, 8);
if (*P(t + 12))
DocDumpMem(*P(t + 12), 16);
// DocDumpMem(*P(t+12), *P(t+4) >> 21 & 0x7FF);
if (!(*P(t) & 1))
{
if (*P(t) & 2)
PutQH(*P(t));
else
PutTD(*P(t));
}
}
U0 PutQH(U32 h)
{
"QH:$$FG,RED$$%08X$$FG$$\n", h;
"%08X\n", *P(h);
"%08X\n", *P(h + 4);
if (!(*P(h) & 1))
{
if (*P(h) & 2)
PutQH(*P(h));
else
PutTD(*P(h));
}
if (!(*P(h + 4) & 1))
{
if (*P(h + 4) & 2)
PutQH(*P(h + 4));
else
PutTD(*P(h + 4));
}
}
U0 PutFrame(U32 f)
{
PutQH(f);
}
U0 PutFrames()
{
I64 i, d, f, w1, w2;
CUSB *u;
for (i = 0; i < sys_num_usb; i++)
{
u = &sys_usb_devs[i];
d = u->ports;
w1 = InU16(d + USBP_PORTSC0);
w2 = InU16(d + USBP_PORTSC1);
if (w1 & 1 || w2 & 1)
{
f = InU32(d + USBP_FRBASEADD);
PutFrame(f);
}
}
}
U0 Main()
{
USBInitAll;
PutStat;
PutFrames;
"$$FG,RED$$The BIOS sets-up the USB in PS/2 legacy mode.$$FG$$\n";
}
Main;
///* Not Finished
#define PORT 5
#define DEV_ADD_INIT 1
#define DEV_ADD 1
#define END_PT0 0
#define END_PT1 1
#define END_PT2 2
#define LEN_MAX 8
#define TERMINATE 1
U0 SetUpTD()
{
CUSB *u = &sys_usb_devs[PORT];
I64 i, d = u->ports;
U32 *frm = CAllocAligned(0x1000, 0x1000, Fs->code_heap),
*tds = CAllocAligned(256, 16, Fs->code_heap),
*buf = CAlloc(128, Fs->code_heap);
DocDump(buf, 128);
"<0>\n"; Sleep(100);
OutU16(d + USBP_CMD, 2); //Reset
"<1>\n"; Sleep(100);
OutU16(d + USBP_CMD, 0);
"<2>\n"; Sleep(100);
OutU16(d + USBP_PORTSC0, 4); //Enable
OutU16(d + USBP_PORTSC1, 4);
"<3>\n"; Sleep(100);
tds[0] = &tds[4](U8 *);
tds[1] = 0;
tds[2] = PID_SETUP + DEV_ADD_INIT << 8 + END_PT0 << 15 + LEN_MAX << 21;
tds[3] = buf;
buf[0] = 0 + RQ_SET_ADDR << 8 + DEV_ADD << 16;
buf[1] = 0 + 0 << 16;
tds[4] = TERMINATE;
tds[5] = 0;
tds[6] = PID_SETUP + DEV_ADD_INIT << 8 + END_PT0 << 15 + LEN_MAX << 21;
tds[7] = buf(U8 *) + 8;
buf[2] = 0 + RQ_SET_ADDR << 8 + DEV_ADD << 16;
buf[3] = 0 + 0 << 16;
frm[0] = &tds[0](U8 *);
for (i = 1; i < 0x1000 / 4; i++)
frm[i] = TERMINATE;
OutU16(d + USBP_FRNUM, frm);
OutU32(d + USBP_FRBASEADD, frm);
"<4>\n"; Sleep(200);
OutU16(d + USBP_CMD,1);
"<5>\n"; Sleep(1000);
OutU16(d + USBP_CMD,0);
"<6>\n"; Sleep(200);
}
SetUpTD;
//*/