1 #include "lolevel.h"
2 #include "platform.h"
3
4 typedef struct {
5 unsigned int address;
6 unsigned int length;
7 } cam_ptp_data_chunk; //camera specific structure
8
9 #define MAX_CHUNKS_FOR_FWT 4 //model specific
10 /*
11 * fwt_data_struct: defined here as it's camera dependent
12 * unneeded members are designated with unkn
13 * file_offset, full_size, seek_flag only needs to be defined for DryOS>=r50 generation cameras
14 * pdc is always required
15 * name is not currently used
16 */
17 typedef struct
18 {
19 int unkn1, unkn2, unkn3, unkn4, unkn5;
20 cam_ptp_data_chunk pdc[MAX_CHUNKS_FOR_FWT];
21 int unkn6;
22 char name[32];
23 } fwt_data_struct;
24
25 #include "../../../generic/filewrite.c"
26
27 // ************ filewritetask *************
28
29 void __attribute__((naked,noinline)) filewritetask () { // sub_FFA791B0
30 asm volatile (
31 " STMFD SP!, {R1-R5,LR} \n"
32 " LDR R4, =0xB414 \n"
33 "loc_FFA791B8:\n"
34 " LDR R0, [R4, #0x10] \n"
35 " MOV R2, #0 \n"
36 " ADD R1, SP, #8 \n"
37 " BL sub_FF8382FC \n"
38 " CMP R0, #0 \n"
39 " BNE loc_FFA791E8 \n"
40 " LDR R0, [SP, #8] \n"
41 " LDR R1, [R0] \n"
42 " CMP R1, #1 \n"
43 " BNE loc_FFA791F0 \n"
44 " LDR R0, [R4, #8] \n"
45 " BL sub_FF8387E8 \n"
46 "loc_FFA791E8:\n"
47 " BL sub_FF81E844 \n"
48 " LDMFD SP!, {R1-R5,PC} \n"
49 "loc_FFA791F0:\n"
50 " SUB R1, R1, #2 \n"
51 " CMP R1, #6 \n"
52 " ADDLS PC, PC, R1, LSL #2 \n"
53 " B loc_FFA791B8 \n"
54 " B loc_FFA7921C \n"
55 " B loc_FFA79280 \n"
56 " B loc_FFA79288 \n"
57 " B loc_FFA79288 \n"
58 " B loc_FFA79288 \n"
59 " B loc_FFA79288 \n"
60 " B loc_FFA79290 \n"
61 "loc_FFA7921C:\n"
62 " MOV R0, #0 \n"
63 " STR R0, [SP] \n"
64 "loc_FFA79224:\n"
65 " LDR R0, [R4, #0x10] \n"
66 " MOV R1, SP \n"
67 " BL sub_FF838540 \n"
68 " LDR R0, [SP] \n"
69 " CMP R0, #0 \n"
70 " BEQ loc_FFA79250 \n"
71 " LDR R0, [R4, #0x10] \n"
72 " MOV R2, #0 \n"
73 " ADD R1, SP, #4 \n"
74 " BL sub_FF8382FC \n"
75 " B loc_FFA79224 \n"
76 "loc_FFA79250:\n"
77 " LDR R0, [R4] \n"
78 " CMN R0, #1 \n"
79 " BEQ loc_FFA79274 \n"
80 " BL fwt_close\n" // mod! sub_FF835414
81 " MVN R0, #0 \n"
82 " STR R0, [R4] \n"
83 " LDR R0, =0xD1D1C \n"
84 " BL sub_FF86E540 \n"
85 " BL sub_FF86C924 \n"
86 "loc_FFA79274:\n"
87 " LDR R0, [R4, #0xC] \n"
88 " BL sub_FF8387E8 \n"
89 " B loc_FFA791B8 \n"
90 "loc_FFA79280:\n"
91 " BL sub_FFA7949C_my \n" // -> open
92 " B loc_FFA791B8 \n"
93 "loc_FFA79288:\n"
94 " BL sub_FFA795D0_my \n" // -> write
95 " B loc_FFA791B8 \n"
96 "loc_FFA79290:\n"
97 " BL sub_FFA79048_my \n" // -> close
98 " B loc_FFA791B8 \n"
99 );
100 }
101
102
103 void __attribute__((naked,noinline)) sub_FFA7949C_my( ) { // open
104 asm volatile (
105 " STMFD SP!, {R4-R8,LR} \n"
106 " MOV R4, R0 \n"
107 " ADD R0, R0, #0x38 \n"
108 " SUB SP, SP, #0x38 \n"
109 " BL sub_FF86E540 \n"
110 " MOV R1, #0 \n"
111 " BL sub_FF86C8D4 \n"
112 " LDR R0, [R4, #0xC] \n"
113 " BL sub_FF86B490 \n"
114 " LDR R7, [R4, #8] \n"
115 " LDR R8, =0x1B6 \n"
116 " ADD R6, R4, #0x38 \n"
117 " LDR R5, [R4, #0xC] \n"
118 //place hook here
119 "STMFD SP!, {R4-R12,LR}\n"
120 "MOV R0, R4\n"
121 "BL filewrite_main_hook\n"
122 "LDMFD SP!, {R4-R12,LR}\n"
123 //hook end
124 " MOV R0, R6 \n"
125 " MOV R1, R7 \n"
126 " MOV R2, R8 \n"
127 " BL fwt_open\n" // mod! sub_FF8353BC
128 "LDR PC, =0xffa794e0\n" // continue in ROM
129 /* " CMN R0, #1 \n"
130 " BNE loc_FFA79540 \n"
131 " MOV R0, R6 \n"
132 " BL sub_FF835780 \n"
133 " MOV R2, #0xF \n"
134 " MOV R1, R6 \n"
135 " MOV R0, SP \n"
136 " BL sub_FFB34DD8 \n"
137 " LDR R0, =0x41FF \n"
138 " MOV R1, #0 \n"
139 " STRB R1, [SP, #0xF] \n"
140 " STR R0, [SP, #0x20] \n"
141 " MOV R0, #0x10 \n"
142 " ADD R2, SP, #0x24 \n"
143 " STMIA R2, {R0,R1,R5} \n"
144 " ADD R1, SP, #0x20 \n"
145 " MOV R0, SP \n"
146 " STR R5, [SP, #0x30] \n"
147 " STR R5, [SP, #0x34] \n"
148 " BL sub_FF86C244 \n"
149 " MOV R2, R8 \n"
150 " MOV R1, R7 \n"
151 " MOV R0, R6 \n"
152 " BL sub_FF8353BC \n"
153 "loc_FFA79540:\n"
154 " LDR R5, =0xB414 \n"
155 " CMN R0, #1 \n"
156 " STR R0, [R5] \n"
157 " BNE loc_FFA79588 \n"
158 " LDR R0, [R5, #0x18] \n"
159 " CMP R0, #0 \n"
160 " BLXNE R0 \n"
161 " ADD R0, R4, #0x38 \n"
162 " BL sub_FF86E540 \n"
163 " BL sub_FF86C924 \n"
164 " LDR R1, [R5, #0x14] \n"
165 " CMP R1, #0 \n"
166 " ADDNE SP, SP, #0x38 \n"
167 " LDMNEFD SP!, {R4-R8,LR} \n"
168 " LDRNE R0, =0x9200001 \n"
169 " BXNE R1 \n"
170 "loc_FFA79580:\n"
171 " ADD SP, SP, #0x38 \n"
172 " LDMFD SP!, {R4-R8,PC} \n"
173 "loc_FFA79588:\n"
174 " LDR R0, =0xD1D1C \n"
175 " MOV R2, #0x20 \n"
176 " ADD R1, R4, #0x38 \n"
177 " BL sub_FFB34F40 \n"
178 " MOV R1, R4 \n"
179 " MOV R0, #4 \n"
180 " BL sub_FFA78F88 \n"
181 " B loc_FFA79580 \n" */
182 );
183 }
184
185
186
187 void __attribute__((naked,noinline)) sub_FFA795D0_my( ) { // write
188 asm volatile (
189 " STMFD SP!, {R4-R10,LR} \n"
190 " MOV R4, R0 \n"
191 " LDR R0, [R0] \n"
192 " CMP R0, #4 \n"
193 " LDREQ R6, [R4, #0x18] \n"
194 " LDREQ R7, [R4, #0x14] \n"
195 " BEQ loc_FFA7961C \n"
196 " CMP R0, #5 \n"
197 " LDREQ R6, [R4, #0x20] \n"
198 " LDREQ R7, [R4, #0x1C] \n"
199 " BEQ loc_FFA7961C \n"
200 " CMP R0, #6 \n"
201 " LDREQ R6, [R4, #0x28] \n"
202 " LDREQ R7, [R4, #0x24] \n"
203 " BEQ loc_FFA7961C \n"
204 " CMP R0, #7 \n"
205 " BNE loc_FFA79630 \n"
206 " LDR R6, [R4, #0x30] \n"
207 " LDR R7, [R4, #0x2C] \n"
208 "loc_FFA7961C:\n"
209 " CMP R6, #0 \n"
210 " BNE loc_FFA79640 \n"
211 "loc_FFA79624:\n"
212 " MOV R1, R4 \n"
213 " MOV R0, #8 \n"
214 " B loc_FFA796D4 \n"
215 "loc_FFA79630:\n"
216 " LDR R1, =0x297 \n"
217 " LDR R0, =0xFFA792A4 \n"
218 " BL sub_FF81E88C \n"
219 " B loc_FFA79624 \n"
220 "loc_FFA79640:\n"
221 " LDR R9, =0xB414 \n"
222 " MOV R5, R6 \n"
223 "loc_FFA79648:\n"
224 " LDR R0, [R4, #4] \n"
225 " CMP R5, #0x1000000 \n"
226 " MOVLS R8, R5 \n"
227 " MOVHI R8, #0x1000000 \n"
228 " BIC R1, R0, #0xFF000000 \n"
229 " CMP R1, #0 \n"
230 " BICNE R0, R0, #0xFF000000 \n"
231 " RSBNE R0, R0, #0x1000000 \n"
232 " CMPNE R8, R0 \n"
233 " MOVHI R8, R0 \n"
234 " LDR R0, [R9] \n"
235 " MOV R2, R8 \n"
236 " MOV R1, R7 \n"
237 " BL fwt_write\n" // mod! sub_FF8354A4
238 " LDR R1, [R4, #4] \n"
239 " CMP R8, R0 \n"
240 " ADD R1, R1, R0 \n"
241 " STR R1, [R4, #4] \n"
242 " BEQ loc_FFA796A8 \n"
243 " CMN R0, #1 \n"
244 " LDRNE R0, =0x9200015 \n"
245 " LDREQ R0, =0x9200005 \n"
246 " STR R0, [R4, #0x10] \n"
247 " B loc_FFA79624 \n"
248 "loc_FFA796A8:\n"
249 " SUB R5, R5, R0 \n"
250 " CMP R5, R6 \n"
251 " ADD R7, R7, R0 \n"
252 " LDRCS R0, =0xFFA792A4 \n"
253 " LDRCS R1, =0x2C2 \n"
254 " BLCS sub_FF81E88C \n"
255 " CMP R5, #0 \n"
256 " BNE loc_FFA79648 \n"
257 " LDR R0, [R4] \n"
258 " MOV R1, R4 \n"
259 " ADD R0, R0, #1 \n"
260 "loc_FFA796D4:\n"
261 " LDMFD SP!, {R4-R10,LR} \n"
262 " B sub_FFA78F88 \n"
263 );
264 }
265
266
267
268 void __attribute__((naked,noinline)) sub_FFA79048_my( ) { // close
269 asm volatile (
270 " STMFD SP!, {R4-R6,LR} \n"
271 " LDR R5, =0xB414 \n"
272 " MOV R4, R0 \n"
273 " LDR R0, [R5] \n"
274 " SUB SP, SP, #0x38 \n"
275 " CMN R0, #1 \n"
276 // " BEQ loc_FFA79090 \n" // -
277 "LDREQ PC, =0xFFA79090\n" // +
278 " LDR R1, [R4, #8] \n"
279 " LDR R6, =0x9200003 \n"
280 " TST R1, #0x8000 \n"
281 " BEQ loc_FFA7907C \n"
282 " BL sub_FF86B984 \n"
283 " B loc_FFA79080 \n"
284 "loc_FFA7907C:\n"
285 " BL fwt_close\n" // mod! sub_FF835414
286 "loc_FFA79080:\n"
287 "LDR PC, =0xFFA79080\n" // continue in ROM
288 /* " CMP R0, #0 \n"
289 " MVN R0, #0 \n"
290 " STRNE R6, [R4, #0x10] \n"
291 " STR R0, [R5] \n"
292 "loc_FFA79090:\n"
293 " LDR R0, [R4, #0x10] \n"
294 " TST R0, #1 \n"
295 " BNE loc_FFA79180 \n"
296 " LDR R0, [R4, #8] \n"
297 " TST R0, #8 \n"
298 " BEQ loc_FFA790D8 \n"
299 " ADD R1, SP, #0x20 \n"
300 " ADD R0, R4, #0x38 \n"
301 " BL sub_FF86C090 \n"
302 " CMP R0, #0 \n"
303 " MOVEQ R1, #0x300 \n"
304 " LDREQ R0, =0xFFA792A4 \n"
305 " BLEQ sub_FF81E88C \n"
306 " LDR R0, [SP, #0x28] \n"
307 " LDR R1, [R4, #4] \n"
308 " ADD R0, R0, R1 \n"
309 " STR R0, [SP, #0x28] \n"
310 " B loc_FFA79108 \n"
311 "loc_FFA790D8:\n"
312 " LDR R0, =0x81FF \n"
313 " STR R0, [SP, #0x20] \n"
314 " MOV R0, #0x20 \n"
315 " STR R0, [SP, #0x24] \n"
316 " LDR R0, [R4, #4] \n"
317 " STR R0, [SP, #0x28] \n"
318 " LDR R0, [R4, #0xC] \n"
319 " STR R0, [SP, #0x2C] \n"
320 " LDR R0, [R4, #0xC] \n"
321 " STR R0, [SP, #0x30] \n"
322 " LDR R0, [R4, #0xC] \n"
323 " STR R0, [SP, #0x34] \n"
324 "loc_FFA79108:\n"
325 " ADD R1, SP, #0x20 \n"
326 " ADD R0, R4, #0x38 \n"
327 " BL sub_FF86C244 \n"
328 " LDR R0, [R4, #0x34] \n"
329 " CMP R0, #0 \n"
330 " BEQ loc_FFA79180 \n"
331 " MOV R2, #0x20 \n"
332 " ADD R1, R4, #0x38 \n"
333 " MOV R0, SP \n"
334 " BL sub_FFB34F40 \n"
335 " MOV R0, SP \n"
336 " BL sub_FF81400C \n"
337 " MOV R2, #0x54 \n"
338 " ADD R0, SP, R0 \n"
339 " MOV R1, #0x4D \n"
340 " STRB R2, [R0, #-3] \n"
341 " STRB R1, [R0, #-2] \n"
342 " MOV R1, #0x50 \n"
343 " STRB R1, [R0, #-1] \n"
344 " MOV R1, SP \n"
345 " ADD R0, R4, #0x38 \n"
346 " BL sub_FF86B9A4 \n"
347 " CMP R0, #0 \n"
348 " LDREQ R1, =0x153 \n"
349 " LDREQ R0, =0xFFA792A4 \n"
350 " BLEQ sub_FF81E88C \n"
351 " MOV R0, SP \n"
352 " BL sub_FF86C6A0 \n"
353 " ADD R0, R4, #0x38 \n"
354 " BL sub_FF86C6A0 \n"
355 "loc_FFA79180:\n"
356 " LDR R0, [R5, #0x18] \n"
357 " CMP R0, #0 \n"
358 " BLXNE R0 \n"
359 " ADD R0, R4, #0x38 \n"
360 " BL sub_FF86E540 \n"
361 " BL sub_FF86C924 \n"
362 " LDR R1, [R5, #0x14] \n"
363 " CMP R1, #0 \n"
364 " LDRNE R0, [R4, #0x10] \n"
365 " BLXNE R1 \n"
366 " ADD SP, SP, #0x38 \n"
367 " LDMFD SP!, {R4-R6,PC} \n" */
368 );
369 }