1 files changed, 65 insertions, 0 deletions
diff --git a/lib/ultralib/src/io/cartrominit.c b/lib/ultralib/src/io/cartrominit.c
new file mode 100644
index 0000000..9cd1617
--- /dev/null
+++ b/lib/ultralib/src/io/cartrominit.c
@@ -0,0 +1,65 @@
+#include "macros.h"
+#include "PR/os_internal.h"
+#include "PR/R4300.h"
+#include "PR/rcp.h"
+
+OSPiHandle __CartRomHandle ALIGNED(8);
+OSPiHandle *osCartRomInit(void)
+{
+   u32 value;
+   u32 saveMask;
+   static int first = 1;
+   register u32 stat;
+   u32 latency;
+   u32 pulse;
+   u32 pageSize;
+   u32 relDuration;
+
+    __osPiGetAccess();
+
+	if (!first) {
+        __osPiRelAccess();
+		return &__CartRomHandle;
+    }
+
+    first = 0;
+	__CartRomHandle.type = DEVICE_TYPE_CART;
+	__CartRomHandle.baseAddress = PHYS_TO_K1(PI_DOM1_ADDR2);
+	__CartRomHandle.domain = PI_DOMAIN1;
+	__CartRomHandle.speed = 0;
+
+	bzero(&__CartRomHandle.transferInfo, sizeof(__OSTranxInfo));
+
+    while (stat = IO_READ(PI_STATUS_REG), stat & (PI_STATUS_DMA_BUSY | PI_STATUS_IO_BUSY)) {
+        ;
+    }
+
+    latency = IO_READ(PI_BSD_DOM1_LAT_REG);
+    pageSize = IO_READ(PI_BSD_DOM1_PGS_REG);
+    relDuration = IO_READ(PI_BSD_DOM1_RLS_REG);
+    pulse = IO_READ(PI_BSD_DOM1_PWD_REG);
+
+    IO_WRITE(PI_BSD_DOM1_LAT_REG, 0xFF);
+    IO_WRITE(PI_BSD_DOM1_PGS_REG, 0);
+    IO_WRITE(PI_BSD_DOM1_RLS_REG, 3);
+    IO_WRITE(PI_BSD_DOM1_PWD_REG, 0xFF);
+
+    value = IO_READ(__CartRomHandle.baseAddress);
+    __CartRomHandle.latency = value & 0xFF;
+    __CartRomHandle.pageSize = (value >> 0x10) & 0xF;
+    __CartRomHandle.relDuration = (value >> 0x14) & 0xF;
+    __CartRomHandle.pulse = (value >> 8) & 0xFF;
+
+    IO_WRITE(PI_BSD_DOM1_LAT_REG, latency);
+    IO_WRITE(PI_BSD_DOM1_PGS_REG, pageSize);
+    IO_WRITE(PI_BSD_DOM1_RLS_REG, relDuration);
+    IO_WRITE(PI_BSD_DOM1_PWD_REG, pulse);
+
+	saveMask = __osDisableInt();
+	__CartRomHandle.next = __osPiTable;
+	__osPiTable = &__CartRomHandle;
+	__osRestoreInt(saveMask);
+    __osPiRelAccess();
+	
+	return &__CartRomHandle;
+}