void exception(void)
{
print_uart("in exception\r\n");
if(!(JTAG_UART_CONFIG & 0x100))
return;
unsigned int readData;
unsigned int readAvailable;
char c;
while(1)
{
readData = JTAG_UART_DATA;
if(!(readData & 0x8000))
break;
c = readData & 0xFF;
while(!((JTAG_UART_CONFIG) & 0xFFFF0000));
JTAG_UART_DATA = c;
++charsSent;
}
HEX_DISPLAY = charsSent;
}
int sd_copy(void *dst, uint32_t src_lba, uint32_t size)
{
uint64_t raw_addr = PITON_SD_BASE_ADDR;
raw_addr += ((uint64_t)src_lba) << 9;
uint64_t * addr = (uint64_t *)raw_addr;
volatile uint64_t * p = (uint64_t *)dst;
for (uint32_t blk = 0; blk < size; blk++) {
if(blk % 100 == 0) {
print_uart("copying block ");
print_uart_dec(blk, 1);
print_uart(" of ");
print_uart_dec(size, 1);
print_uart(" blocks (");
print_uart_dec((blk*100)/size, 1);
print_uart(" %)\r\n");
}
for (uint32_t offset = 0; offset < 64; offset++) {
*(p++) = *(addr++);
}
}
return 0;
}
void main()
{
unsigned long number,i;
#ifdef RTL_SIM
print("This program is based on Steve Rhoards-san,author of plasma.\n");
#endif
print("Mult by 3\r\n");
for (i=0;i<3;i=i+1) print_uart("uart port test\n");
number=3;
for(i=0;;++i) {
number_text(number);
number*=3;
#ifdef RTL_SIM
if (i==18){
print(" ");//flush
print("$finish");
}
#endif
}
}
int init_sd()
{
print_uart("initializing SD... \r\n");
return 0;
}
int gpt_find_boot_partition(uint8_t* dest, uint32_t size)
{
int ret = init_sd();
if (ret != 0) {
print_uart("could not initialize sd... exiting\r\n");
return -1;
}
print_uart("sd initialized!\r\n");
// load LBA1
size_t block_size = 512;
uint8_t lba1_buf[block_size];
int res = sd_copy(lba1_buf, 1, 1);
if (res != 0)
{
print_uart("SD card failed!\r\n");
print_uart("sd copy return value: ");
print_uart_addr(res);
print_uart("\r\n");
return -2;
}
gpt_pth_t *lba1 = (gpt_pth_t *)lba1_buf;
print_uart("gpt partition table header:");
print_uart("\r\n\tsignature:\t");
print_uart_addr(lba1->signature);
print_uart("\r\n\trevision:\t");
print_uart_int(lba1->revision);
print_uart("\r\n\tsize:\t\t");
print_uart_int(lba1->header_size);
print_uart("\r\n\tcrc_header:\t");
print_uart_int(lba1->crc_header);
print_uart("\r\n\treserved:\t");
print_uart_int(lba1->reserved);
print_uart("\r\n\tcurrent lba:\t");
print_uart_addr(lba1->current_lba);
print_uart("\r\n\tbackup lda:\t");
print_uart_addr(lba1->backup_lba);
print_uart("\r\n\tpartition entries lba: \t");
print_uart_addr(lba1->partition_entries_lba);
print_uart("\r\n\tnumber partition entries:\t");
print_uart_int(lba1->nr_partition_entries);
print_uart("\r\n\tsize partition entries: \t");
print_uart_int(lba1->size_partition_entry);
print_uart("\r\n");
uint8_t lba2_buf[block_size];
res = sd_copy(lba2_buf, lba1->partition_entries_lba, 1);
if (res != 0)
{
print_uart("SD card failed!\r\n");
print_uart("sd copy return value: ");
print_uart_addr(res);
print_uart("\r\n");
return -2;
}
for (int i = 0; i < 4; i++)
{
partition_entries_t *part_entry = (partition_entries_t *)(lba2_buf + (i * 128));
print_uart("gpt partition entry ");
print_uart_byte(i);
print_uart("\r\n\tpartition type guid:\t");
for (int j = 0; j < 16; j++)
print_uart_byte(part_entry->partition_type_guid[j]);
print_uart("\r\n\tpartition guid: \t");
for (int j = 0; j < 16; j++)
print_uart_byte(part_entry->partition_guid[j]);
print_uart("\r\n\tfirst lba:\t");
print_uart_addr(part_entry->first_lba);
print_uart("\r\n\tlast lba:\t");
print_uart_addr(part_entry->last_lba);
print_uart("\r\n\tattributes:\t");
print_uart_addr(part_entry->attributes);
print_uart("\r\n\tname:\t");
for (int j = 0; j < 72; j++)
print_uart_byte(part_entry->name[j]);
print_uart("\r\n");
}
partition_entries_t *boot = (partition_entries_t *)(lba2_buf);
print_uart("copying boot image ");
print_uart("\r\n");
res = sd_copy(dest, boot->first_lba, size);
if (res != 0)
{
print_uart("SD card failed!\r\n");
print_uart("sd copy return value: ");
print_uart_addr(res);
print_uart("\r\n");
return -2;
}
print_uart(" done!\r\n");
return 0;
}