TempleOSTS_130315.ISO

TempleOS/Accts/TS/TAD/Archive/USB1a.CPP

@@ -0,0 +1,114 @@
+#define USBP_CMD	0x00
+#define USBP_STS	0x02
+#define USBP_INTR	0x04
+#define USBP_FRNUM	0x06
+#define USBP_FRBASEADD	0x08
+#define USBP_SOFMOD	0x0C
+#define USBP_PORTSC0	0x10
+#define USBP_PORTSC1	0x12
+#define MAX_USB	16
+
+class CUSBTD //Not implemented
+{
+  U32 td[4];
+};
+
+class CUSB //Not implemented
+{
+  U8 num, //USB dev num
+     bus,dev,fun;
+  U16 ports,pad;
+  U32 *frame_lst;
+};
+
+//USB Pkt ID's
+#define PID_OUT		0xE1
+#define PID_IN		0x69
+#define PID_SOF		0xA5
+#define PID_SETUP	0x2D
+#define PID_DATA0	0xC3
+#define PID_DATA1	0x4B
+#define PID_DATA2	0x87
+#define PID_MDATA	0x0F
+#define PID_ACK		0xD2
+#define PID_NAK		0x5A
+#define PID_STALL	0x1E
+#define PID_NYET	0x96
+#define PID_PRE		0x3C
+#define PID_ERR		0x3C
+#define PID_SPLIT	0x78
+#define PID_PING	0xB4
+
+//USB Std Rqsts
+#define RQ_GET_STAT	0x0
+#define RQ_CLR_FEAT	0x1
+#define RQ_SET_FEAT	0x3
+#define RQ_SET_ADDR	0x5
+#define RQ_SET_DESC	0x7
+#define RQ_GET_CFG	0x8
+#define RQ_SET_CFG	0x9
+#define RQ_GET_INTERFACE 0xA
+#define RQ_SET_INTERFACE 0xB
+#define RQ_SYNC_FRAME	0xC
+
+I64 sys_num_usb=0;
+CUSB sys_usb_devs[MAX_USB];
+MemSet(sys_usb_devs,0,MAX_USB*sizeof(CUSB));
+
+
+U0 USBInitOne(I64 b,I64 d,I64 f)
+{
+  CUSB *u;
+  if (sys_num_usb<MAX_USB &&
+      PCIReadU16(b,d,f,0)==0x8086) {
+    u=&sys_usb_devs[sys_num_usb++];
+    u->num=sys_num_usb;
+    u->bus=b;
+    u->dev=d;
+    u->fun=f;
+    u->ports=PCIReadU32(b,d,f,0x20)&~0x1F;
+  }
+}
+
+U0 USBEndAll()
+{
+  sys_num_usb=0;
+}
+
+U0 USBInitAll() //This is only valid for my ICH10 dev
+{
+  if (sys_num_usb)
+    USBEndAll;
+  USBInitOne(0,29,0);
+  USBInitOne(0,29,1);
+  USBInitOne(0,29,2);
+  USBInitOne(0,29,3);
+  USBInitOne(0,26,0);
+  USBInitOne(0,26,1);
+  USBInitOne(0,26,2);
+}
+
+CUSBTD *USBAllocTD()
+{
+  return MAllocAligned(sizeof(CUSBTD),0x10,sys_uncached_heap);
+}
+
+U0 USBFreeTD(CUSBTD *temptd)
+{
+  Free(temptd);
+}
+
+U32 *USBAllocFrameLst(I64 usb_num,I64 size)
+{ //aligned to 0x1000
+  CUSB *u;
+  if (0<=usb_num<sys_num_usb) {
+    u=&sys_usb_devs[usb_num];
+    Free(u->frame_lst);
+    u->frame_lst=MAllocAligned(size*sizeof(U32),0x1000,sys_uncached_heap);
+    OutU16(u->ports+USBP_CMD,0); //Stop
+    OutU16(u->ports+USBP_FRNUM,0);
+    OutU32(u->ports+USBP_FRBASEADD,u->frame_lst);
+    return u->frame_lst;
+  }
+  return NULL;
+}