blob: e90ea1f678eba7a2f00300a7343089f9cef49ff7 (
plain)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
|
#include "ultra64/leo.h"
#include "ultra64/leoappli.h"
#include "ultra64/leodrive.h"
#include "array_count.h"
#include "ultra64.h"
u16 leoLba_to_phys(u32 lba) {
u16 vzone_num;
u16 zone_slba;
u16 zone_scyl;
u16 zone_tk;
u16 bad_tk_num;
u32 counter;
u16 def_offset;
u16 defect;
u8 def_zone_no;
// A cylinder track is made of two blocks, so we may be able to only read one of it if the next block is on the next
// cylinder
LEOtgt_param.rdwr_blocks = 2 - (lba & 1);
// Blocks are interleaved between cylinders
switch (lba & 3) {
case 0:
case 3:
LEOtgt_param.start_block = 0;
break;
default:
LEOtgt_param.start_block = 1;
break;
}
// Get Virtual & Physical Disk Zones from LBA
vzone_num = leoLba_to_vzone(lba);
// Set Parameter Disk Head & Zone
LEOtgt_param.zone = def_zone_no = LEOVZONE_PZONEHD_TBL[LEOdisk_type][vzone_num];
LEOtgt_param.head = 0;
if (LEOtgt_param.zone > 7) {
LEOtgt_param.zone -= 7;
LEOtgt_param.head = 1;
}
// Get the start cylinder from current zone
zone_scyl = LEOZONE_SCYL_TBL[def_zone_no];
// Get Virtual Zone LBA start, if Zone 0, it's LBA 0
if (vzone_num != 0) {
zone_slba = LEOVZONE_TBL[LEOdisk_type][vzone_num - 1];
} else {
zone_slba = 0;
}
// Get Cylinder relative of the current Zone
zone_tk = (lba - zone_slba) / 2;
// Calculate Physical Cylinder
if (LEOtgt_param.head != 0) {
LEOtgt_param.cylinder = zone_scyl - zone_tk;
zone_scyl = LEOZONE_OUTERCYL_TBL[LEOtgt_param.zone - 1];
} else {
LEOtgt_param.cylinder = zone_scyl + zone_tk;
}
// Get the relative offset to defect tracks for the current zone (if Zone 0, then it's 0)
if ((u32)def_zone_no != 0) {
def_offset = LEO_sys_data.param.defect_num[def_zone_no - 1];
} else {
def_offset = 0;
}
// Get amount of defect tracks for the current zone
bad_tk_num = LEO_sys_data.param.defect_num[def_zone_no] - def_offset;
// Skip defective cylinders
while (bad_tk_num != 0) {
defect = zone_scyl + LEO_sys_data.param.defect_data[def_offset];
if (LEOtgt_param.cylinder < defect) {
break;
}
LEOtgt_param.cylinder++;
def_offset++;
bad_tk_num--;
}
// Set sector and block size info
LEOtgt_param.sec_bytes = LEOBYTE_TBL1[LEOtgt_param.zone];
LEOtgt_param.blk_bytes = LEOBYTE_TBL2[LEOtgt_param.zone];
// For development disks
if (LEO_country_code == 0 && lba < 12) {
LEOtgt_param.sec_bytes = 0xC0;
LEOtgt_param.blk_bytes = 0x3FC0;
}
return 0;
}
u16 leoLba_to_vzone(u32 lba) {
u16 i;
const u16* ptr = LEOVZONE_TBL[LEOdisk_type];
for (i = 0; i < ARRAY_COUNT(LEOVZONE_TBL[LEOdisk_type]); i++, ptr++) {
if (lba < *ptr) {
return i;
}
}
return 0xFF;
}
|
