mirror of
https://github.com/Polprzewodnikowy/SummerCart64.git
synced 2024-11-24 22:56:52 +01:00
414 lines
11 KiB
C
414 lines
11 KiB
C
// Original code sourced from https://github.com/jago85/UltraCIC_C
|
|
|
|
// MIT License
|
|
|
|
// Copyright (c) 2019 Jan Goldacker
|
|
// Copyright (c) 2022-2024 Mateusz Faderewski
|
|
|
|
// Permission is hereby granted, free of charge, to any person obtaining a copy
|
|
// of this software and associated documentation files (the "Software"), to deal
|
|
// in the Software without restriction, including without limitation the rights
|
|
// to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
|
|
// copies of the Software, and to permit persons to whom the Software is
|
|
// furnished to do so, subject to the following conditions:
|
|
|
|
// The above copyright notice and this permission notice shall be included in all
|
|
// copies or substantial portions of the Software.
|
|
|
|
// THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
|
|
// IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
|
|
// FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
|
|
// AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
|
|
// LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
|
|
// OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
|
|
// SOFTWARE.
|
|
|
|
#include <stdbool.h>
|
|
#include <stddef.h>
|
|
#include <stdint.h>
|
|
|
|
|
|
typedef struct {
|
|
volatile uint32_t CIC_CONFIG[2];
|
|
volatile uint32_t IO;
|
|
volatile uint32_t DEBUG;
|
|
} ext_regs_t;
|
|
|
|
#define EXT ((ext_regs_t *) (0xC0000000UL))
|
|
|
|
#define CIC_DQ (1 << 0) // IO
|
|
#define CIC_CLK (1 << 1) // I
|
|
#define CIC_RESET (1 << 2) // I
|
|
#define CIC_TIMER_ELAPSED (1 << 3) // I
|
|
#define CIC_TIMER_START (1 << 4) // O
|
|
#define CIC_TIMER_CLEAR (1 << 5) // O
|
|
#define CIC_INVALID_REGION (1 << 6) // O
|
|
|
|
#define CIC_INIT() { EXT->IO = (CIC_TIMER_CLEAR | CIC_DQ); }
|
|
#define CIC_IS_RUNNING() (EXT->IO & CIC_RESET)
|
|
#define CIC_CLK_WAIT_LOW() { while ((EXT->IO & (CIC_TIMER_ELAPSED | CIC_RESET | CIC_CLK)) == (CIC_RESET | CIC_CLK)); }
|
|
#define CIC_CLK_WAIT_HIGH() { while ((EXT->IO & (CIC_TIMER_ELAPSED | CIC_RESET | CIC_CLK)) == CIC_RESET); }
|
|
#define CIC_CLK_IS_LOW() ((EXT->IO & (CIC_RESET | CIC_CLK)) == CIC_RESET)
|
|
#define CIC_DQ_GET() (EXT->IO & CIC_DQ)
|
|
#define CIC_DQ_SET(v) { EXT->IO = ((v) ? CIC_DQ : 0); }
|
|
#define CIC_NOTIFY_INVALID_REGION() { EXT->IO = (CIC_INVALID_REGION | CIC_DQ); }
|
|
#define CIC_TIMEOUT_START() { EXT->IO = (CIC_TIMER_START | CIC_DQ); }
|
|
#define CIC_TIMEOUT_STOP() { EXT->IO = (CIC_TIMER_CLEAR | CIC_DQ); }
|
|
#define CIC_TIMEOUT_ELAPSED() (EXT->IO & CIC_TIMER_ELAPSED)
|
|
#define CIC_SET_STEP(v) { EXT->DEBUG = (v); }
|
|
|
|
|
|
typedef enum {
|
|
CIC_STEP_UNAVAILABLE = 0,
|
|
CIC_STEP_POWER_OFF = 1,
|
|
CIC_STEP_CONFIG_LOAD = 2,
|
|
CIC_STEP_ID = 3,
|
|
CIC_STEP_SEED = 4,
|
|
CIC_STEP_CHECKSUM = 5,
|
|
CIC_STEP_INIT_RAM = 6,
|
|
CIC_STEP_COMMAND = 7,
|
|
CIC_STEP_COMPARE = 8,
|
|
CIC_STEP_X105 = 9,
|
|
CIC_STEP_RESET_BUTTON = 10,
|
|
CIC_STEP_DIE_DISABLED = 11,
|
|
CIC_STEP_DIE_64DD = 12,
|
|
CIC_STEP_DIE_INVALID_REGION = 13,
|
|
CIC_STEP_DIE_COMMAND = 14,
|
|
} cic_step_t;
|
|
|
|
typedef struct {
|
|
bool cic_disabled;
|
|
bool cic_64dd_mode;
|
|
bool cic_region;
|
|
uint8_t cic_seed;
|
|
uint8_t cic_checksum[6];
|
|
} cic_config_t;
|
|
|
|
static cic_config_t config;
|
|
|
|
static uint8_t cic_ram[32];
|
|
static uint8_t cic_x105_ram[30];
|
|
|
|
static const uint8_t cic_ram_init[2][16] = {{
|
|
0xE0, 0x9A, 0x18, 0x5A, 0x13, 0xE1, 0x0D, 0xEC, 0x0B, 0x14, 0xF8, 0xB5, 0x7C, 0xD6, 0x1E, 0x98
|
|
}, {
|
|
0xE0, 0x4F, 0x51, 0x21, 0x71, 0x98, 0x57, 0x5A, 0x0B, 0x12, 0x3F, 0x82, 0x71, 0x98, 0x11, 0x5C
|
|
}};
|
|
|
|
|
|
static void cic_die (void) {
|
|
while (CIC_IS_RUNNING());
|
|
}
|
|
|
|
static void cic_wait_power_on (void) {
|
|
CIC_INIT();
|
|
while (!CIC_IS_RUNNING());
|
|
}
|
|
|
|
static void cic_load_config (void) {
|
|
uint32_t cic_config[2];
|
|
|
|
cic_config[0] = EXT->CIC_CONFIG[0];
|
|
cic_config[1] = EXT->CIC_CONFIG[1];
|
|
|
|
config.cic_disabled = (cic_config[0] & (1 << 26));
|
|
config.cic_64dd_mode = (cic_config[0] & (1 << 25));
|
|
config.cic_region = (cic_config[0] & (1 << 24));
|
|
config.cic_seed = ((cic_config[0] >> 16) & 0xFF);
|
|
config.cic_checksum[0] = ((cic_config[0] >> 8) & 0xFF);
|
|
config.cic_checksum[1] = (cic_config[0] & 0xFF);
|
|
config.cic_checksum[2] = ((cic_config[1] >> 24) & 0xFF);
|
|
config.cic_checksum[3] = ((cic_config[1] >> 16) & 0xFF);
|
|
config.cic_checksum[4] = ((cic_config[1] >> 8) & 0xFF);
|
|
config.cic_checksum[5] = (cic_config[1] & 0xFF);
|
|
|
|
if (config.cic_disabled) {
|
|
CIC_SET_STEP(CIC_STEP_DIE_DISABLED);
|
|
cic_die();
|
|
}
|
|
}
|
|
|
|
static uint8_t cic_read (void) {
|
|
uint8_t value;
|
|
CIC_CLK_WAIT_LOW();
|
|
value = CIC_DQ_GET() ? 1 : 0;
|
|
CIC_CLK_WAIT_HIGH();
|
|
return value;
|
|
}
|
|
|
|
static void cic_write (uint8_t value) {
|
|
CIC_CLK_WAIT_LOW();
|
|
CIC_DQ_SET(value);
|
|
CIC_CLK_WAIT_HIGH();
|
|
CIC_DQ_SET(1);
|
|
}
|
|
|
|
static uint8_t cic_read_nibble (void) {
|
|
uint8_t data = 0;
|
|
for (int i = 0; i < 4; i++) {
|
|
data = ((data << 1) | cic_read());
|
|
}
|
|
return data;
|
|
}
|
|
|
|
static void cic_write_nibble (uint8_t data) {
|
|
cic_write(data & 0x08);
|
|
cic_write(data & 0x04);
|
|
cic_write(data & 0x02);
|
|
cic_write(data & 0x01);
|
|
}
|
|
|
|
static void cic_write_ram_nibbles (uint8_t index) {
|
|
do {
|
|
cic_write_nibble(cic_ram[index++]);
|
|
} while ((index & 0x0F) != 0);
|
|
}
|
|
|
|
static void cic_encode_round (uint8_t index) {
|
|
uint8_t data = cic_ram[index++];
|
|
do {
|
|
data = ((((data + 1) & 0x0F) + cic_ram[index]) & 0x0F);
|
|
cic_ram[index++] = data;
|
|
} while ((index & 0x0F) != 0);
|
|
}
|
|
|
|
static void cic_write_id (void) {
|
|
if (config.cic_64dd_mode) {
|
|
CIC_CLK_WAIT_LOW();
|
|
while (CIC_CLK_IS_LOW()) {
|
|
if (!CIC_DQ_GET()) {
|
|
CIC_SET_STEP(CIC_STEP_DIE_64DD);
|
|
cic_die();
|
|
}
|
|
}
|
|
} else {
|
|
cic_write(0);
|
|
}
|
|
cic_write(config.cic_region ? 1 : 0);
|
|
cic_write(0);
|
|
cic_write(1);
|
|
}
|
|
|
|
static void cic_write_seed (void) {
|
|
cic_ram[0x0A] = 0x0B;
|
|
cic_ram[0x0B] = 0x05;
|
|
cic_ram[0x0C] = (config.cic_seed >> 4);
|
|
cic_ram[0x0D] = config.cic_seed;
|
|
cic_ram[0x0E] = (config.cic_seed >> 4);
|
|
cic_ram[0x0F] = config.cic_seed;
|
|
cic_encode_round(0x0A);
|
|
cic_encode_round(0x0A);
|
|
|
|
CIC_TIMEOUT_START();
|
|
|
|
cic_write_ram_nibbles(0x0A);
|
|
|
|
if (CIC_TIMEOUT_ELAPSED()) {
|
|
CIC_NOTIFY_INVALID_REGION();
|
|
CIC_SET_STEP(CIC_STEP_DIE_INVALID_REGION);
|
|
cic_die();
|
|
}
|
|
|
|
CIC_TIMEOUT_STOP();
|
|
}
|
|
|
|
static void cic_write_checksum (void) {
|
|
for (int i = 0; i < 4; i++) {
|
|
cic_ram[i] = 0x00;
|
|
}
|
|
for (int i = 0; i < 6; i++) {
|
|
uint8_t value = config.cic_checksum[i];
|
|
cic_ram[(i * 2) + 4] = ((value >> 4) & 0x0F);
|
|
cic_ram[(i * 2) + 5] = (value & 0x0F);
|
|
}
|
|
cic_encode_round(0x00);
|
|
cic_encode_round(0x00);
|
|
cic_encode_round(0x00);
|
|
cic_encode_round(0x00);
|
|
cic_read();
|
|
cic_write_ram_nibbles(0x00);
|
|
}
|
|
|
|
static void cic_init_ram (void) {
|
|
for (int i = 0; i < 16; i++) {
|
|
uint8_t value = cic_ram_init[config.cic_region ? 1 : 0][i];
|
|
cic_ram[(i * 2)] = ((value >> 4) & 0x0F);
|
|
cic_ram[(i * 2) + 1] = (value & 0x0F);
|
|
}
|
|
cic_ram[0x01] = cic_read_nibble();
|
|
cic_ram[0x11] = cic_read_nibble();
|
|
}
|
|
|
|
static void cic_exchange_bytes (uint8_t *a, uint8_t *b) {
|
|
uint8_t tmp = *a;
|
|
*a = *b;
|
|
*b = tmp;
|
|
}
|
|
|
|
static void cic_round (uint8_t *m) {
|
|
uint8_t a, b, x;
|
|
|
|
x = m[15];
|
|
a = x;
|
|
|
|
do {
|
|
b = 1;
|
|
a += (m[b] + 1);
|
|
m[b] = a;
|
|
b++;
|
|
a += (m[b] + 1);
|
|
cic_exchange_bytes(&a, &m[b]);
|
|
m[b] = ~(m[b]);
|
|
b++;
|
|
a &= 0x0F;
|
|
a += ((m[b] & 0x0F) + 1);
|
|
if (a < 16) {
|
|
cic_exchange_bytes(&a, &m[b]);
|
|
b++;
|
|
}
|
|
a += m[b];
|
|
m[b] = a;
|
|
b++;
|
|
a += m[b];
|
|
cic_exchange_bytes(&a, &m[b]);
|
|
b++;
|
|
a &= 0x0F;
|
|
a += 8;
|
|
if (a < 16) {
|
|
a += m[b];
|
|
}
|
|
cic_exchange_bytes(&a, &m[b]);
|
|
b++;
|
|
do {
|
|
a += (m[b] + 1);
|
|
m[b] = a;
|
|
b++;
|
|
b &= 0x0F;
|
|
} while (b != 0);
|
|
a = (x + 0x0F);
|
|
x = (a & 0x0F);
|
|
} while (x != 0x0F);
|
|
}
|
|
|
|
static void cic_compare_mode (void) {
|
|
cic_round(&cic_ram[0x10]);
|
|
cic_round(&cic_ram[0x10]);
|
|
cic_round(&cic_ram[0x10]);
|
|
|
|
uint8_t index = (cic_ram[0x17] & 0x0F);
|
|
if (index == 0) {
|
|
index = 1;
|
|
}
|
|
index |= 0x10;
|
|
|
|
do {
|
|
cic_read();
|
|
cic_write(cic_ram[index] & 0x01);
|
|
if (config.cic_region) {
|
|
index--;
|
|
} else {
|
|
index++;
|
|
}
|
|
} while (index & 0x0F);
|
|
}
|
|
|
|
static void cic_x105_algorithm (void) {
|
|
uint8_t a = 5;
|
|
uint8_t carry = 1;
|
|
|
|
for (int i = 0; i < 30; ++i) {
|
|
if (!(cic_x105_ram[i] & 0x01)) {
|
|
a += 8;
|
|
}
|
|
if (!(a & 0x02)) {
|
|
a += 4;
|
|
}
|
|
a = ((a + cic_x105_ram[i]) & 0x0F);
|
|
cic_x105_ram[i] = a;
|
|
if (!carry) {
|
|
a += 7;
|
|
}
|
|
a = ((a + cic_x105_ram[i]) & 0x0F);
|
|
a = (a + cic_x105_ram[i] + carry);
|
|
if (a >= 0x10) {
|
|
carry = 1;
|
|
a -= 0x10;
|
|
} else {
|
|
carry = 0;
|
|
}
|
|
a = (~(a) & 0x0F);
|
|
cic_x105_ram[i] = a;
|
|
}
|
|
}
|
|
|
|
static void cic_x105_mode (void) {
|
|
cic_write_nibble(0x0A);
|
|
cic_write_nibble(0x0A);
|
|
|
|
for (int i = 0; i < 30; i++) {
|
|
cic_x105_ram[i] = cic_read_nibble();
|
|
}
|
|
|
|
cic_x105_algorithm();
|
|
|
|
cic_write(0);
|
|
|
|
for (int i = 0; i < 30; i++) {
|
|
cic_write_nibble(cic_x105_ram[i]);
|
|
}
|
|
}
|
|
|
|
static void cic_soft_reset (void) {
|
|
CIC_CLK_WAIT_LOW();
|
|
|
|
CIC_TIMEOUT_START();
|
|
while ((!CIC_TIMEOUT_ELAPSED()) && CIC_IS_RUNNING());
|
|
CIC_TIMEOUT_STOP();
|
|
|
|
cic_write(0);
|
|
}
|
|
|
|
|
|
__attribute__((naked)) void cic_main (void) {
|
|
while (true) {
|
|
CIC_SET_STEP(CIC_STEP_POWER_OFF);
|
|
cic_wait_power_on();
|
|
|
|
CIC_SET_STEP(CIC_STEP_CONFIG_LOAD);
|
|
cic_load_config();
|
|
|
|
CIC_SET_STEP(CIC_STEP_ID);
|
|
cic_write_id();
|
|
|
|
CIC_SET_STEP(CIC_STEP_SEED);
|
|
cic_write_seed();
|
|
|
|
CIC_SET_STEP(CIC_STEP_CHECKSUM);
|
|
cic_write_checksum();
|
|
|
|
CIC_SET_STEP(CIC_STEP_INIT_RAM);
|
|
cic_init_ram();
|
|
|
|
while (CIC_IS_RUNNING()) {
|
|
CIC_SET_STEP(CIC_STEP_COMMAND);
|
|
uint8_t cmd = 0;
|
|
cmd |= (cic_read() << 1);
|
|
cmd |= cic_read();
|
|
|
|
if (cmd == 0) {
|
|
CIC_SET_STEP(CIC_STEP_COMPARE);
|
|
cic_compare_mode();
|
|
} else if (cmd == 2) {
|
|
CIC_SET_STEP(CIC_STEP_X105);
|
|
cic_x105_mode();
|
|
} else if (cmd == 3) {
|
|
CIC_SET_STEP(CIC_STEP_RESET_BUTTON);
|
|
cic_soft_reset();
|
|
} else {
|
|
CIC_SET_STEP(CIC_STEP_DIE_COMMAND);
|
|
cic_die();
|
|
}
|
|
}
|
|
}
|
|
}
|