de4a0279 |
1 | /* |
2 | * SPU processing offload to TI C64x DSP using bsp's c64_tools |
3 | * (C) GraÅžvydas "notaz" Ignotas, 2015 |
4 | * |
5 | * Permission is hereby granted, free of charge, to any person obtaining a copy of |
6 | * this software and associated documentation files (the "Software"), to deal in |
7 | * the Software without restriction, including without limitation the rights to |
8 | * use, copy, modify, merge, publish, distribute, sublicense, and/or sell copies |
9 | * of the Software, and to permit persons to whom the Software is furnished to do |
10 | * so, subject to the following conditions: |
11 | * |
12 | * The above copyright notice and this permission notice shall be included in all |
13 | * copies or substantial portions of the Software. |
14 | * |
15 | * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR |
16 | * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, |
17 | * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE |
18 | * AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER |
19 | * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, |
20 | * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE |
21 | * SOFTWARE. |
22 | */ |
23 | |
24 | #define SYSCALLS_C |
25 | #include <libc64_dsp/include/inc_overlay.h> |
26 | #include <stddef.h> |
27 | |
28 | #include "spu.c" |
29 | #include "spu_c64x.h" |
30 | |
31 | /* dummy deps, some bloat but avoids ifdef hell in SPU code.. */ |
32 | static void thread_work_start(void) {} |
3bd31caf |
33 | static void thread_work_wait_sync(struct work_item *work, int force) {} |
34 | static int thread_get_i_done(void) { return 0; } |
de4a0279 |
35 | struct out_driver *out_current; |
36 | void SetupSound(void) {} |
37 | |
3bd31caf |
38 | |
39 | static void invalidate_cache(struct work_item *work) |
40 | { |
41 | syscalls.cache_inv(work, offsetof(typeof(*work), RVB), 1); |
42 | syscalls.cache_inv(spu.s_chan, sizeof(spu.s_chan[0]) * 24, 0); |
43 | syscalls.cache_inv(work->SSumLR, |
44 | sizeof(work->SSumLR[0]) * 2 * work->ns_to, 0); |
45 | } |
46 | |
47 | static void writeout_cache(struct work_item *work) |
de4a0279 |
48 | { |
3bd31caf |
49 | int ns_to = work->ns_to; |
50 | |
51 | syscalls.cache_wb(work->RVB, sizeof(work->RVB[0]) * 2 * ns_to, 1); |
52 | syscalls.cache_wb(work->SSumLR, sizeof(work->SSumLR[0]) * 2 * ns_to, 1); |
53 | } |
de4a0279 |
54 | |
3bd31caf |
55 | static void do_processing(void) |
56 | { |
57 | struct work_item *work; |
58 | int left, dirty = 0; |
de4a0279 |
59 | |
3bd31caf |
60 | while (worker->active) |
61 | { |
62 | // i_ready is in first cacheline |
63 | syscalls.cache_inv(worker, 64, 1); |
64 | |
65 | left = worker->i_ready - worker->i_done; |
66 | if (left > 0) { |
67 | dirty = 1; |
68 | worker->active = ACTIVE_CNT; |
69 | syscalls.cache_wb(&worker->active, 4, 1); |
70 | |
71 | work = &worker->i[worker->i_done & WORK_I_MASK]; |
72 | invalidate_cache(work); |
73 | do_channel_work(work); |
74 | writeout_cache(work); |
75 | |
76 | worker->i_done++; |
77 | syscalls.cache_wb(&worker->i_done, 4, 1); |
78 | continue; |
79 | } |
80 | |
81 | // nothing to do? Write out non-critical caches |
82 | if (dirty) { |
83 | syscalls.cache_wb(spu.spuMemC + 0x800, 0x800, 1); |
84 | syscalls.cache_wb(spu.SB, sizeof(spu.SB[0]) * SB_SIZE * 24, 1); |
85 | dirty = 0; |
86 | continue; |
87 | } |
88 | |
89 | // this ->active loop thing is to avoid a race where we miss |
90 | // new work and clear ->active just after ARM checks it |
91 | worker->active--; |
92 | syscalls.cache_wb(&worker->active, 4, 1); |
93 | } |
de4a0279 |
94 | } |
de4a0279 |
95 | |
96 | static unsigned int exec(dsp_component_cmd_t cmd, |
97 | unsigned int arg1, unsigned int arg2, |
98 | unsigned int *ret1, unsigned int *ret2) |
99 | { |
100 | struct region_mem *mem = (void *)arg1; |
de4a0279 |
101 | |
102 | switch (cmd) { |
103 | case CCMD_INIT: |
104 | InitADSR(); |
105 | |
106 | spu.spuMemC = mem->spu_ram; |
de4a0279 |
107 | spu.SB = mem->SB; |
108 | spu.s_chan = mem->s_chan; |
109 | worker = &mem->worker; |
110 | memcpy(&spu_config, &mem->spu_config, sizeof(spu_config)); |
111 | |
112 | mem->sizeof_region_mem = sizeof(*mem); |
113 | mem->offsetof_s_chan1 = offsetof(typeof(*mem), s_chan[1]); |
3bd31caf |
114 | mem->offsetof_spos_3_20 = offsetof(typeof(*mem), worker.i[3].ch[20]); |
de4a0279 |
115 | // seems to be unneeded, no write-alloc? but just in case.. |
116 | syscalls.cache_wb(&mem->sizeof_region_mem, 3 * 4, 1); |
117 | break; |
118 | |
119 | case CCMD_DOIT: |
3bd31caf |
120 | worker->active = ACTIVE_CNT; |
121 | worker->boot_cnt++; |
122 | syscalls.cache_wb(&worker->i_done, 64, 1); |
123 | memcpy(&spu_config, &mem->spu_config, sizeof(spu_config)); |
124 | |
125 | do_processing(); |
126 | |
de4a0279 |
127 | // c64_tools lib does BCACHE_wbInvAll() when it receives mailbox irq, |
3bd31caf |
128 | // but invalidate anyway in case c64_tools is ever fixed.. |
129 | syscalls.cache_inv(mem, sizeof(mem->spu_ram) + sizeof(mem->SB), 0); |
de4a0279 |
130 | break; |
131 | |
132 | default: |
133 | syscalls.printf("bad cmd: %x\n", cmd); |
134 | break; |
135 | } |
136 | |
137 | return 0; |
138 | } |
139 | |
140 | #pragma DATA_SECTION(component_test_dsp, ".sec_com"); |
141 | dsp_component_t component_test_dsp = { |
142 | { |
143 | NULL, /* init */ |
144 | exec, |
145 | NULL, /* exec fastcall RPC */ |
146 | NULL, /* exit */ |
147 | }, |
148 | |
149 | COMPONENT_NAME, |
150 | }; |
151 | |
152 | DSP_COMPONENT_MAIN |
153 | |
154 | // vim:shiftwidth=1:expandtab |