|
4165
|
1 /*
|
|
|
2 * SDL - Simple DirectMedia Layer
|
|
|
3 * CELL BE Support for PS3 Framebuffer
|
|
|
4 * Copyright (C) 2008, 2009 International Business Machines Corporation
|
|
|
5 *
|
|
|
6 * This library is free software; you can redistribute it and/or modify it
|
|
|
7 * under the terms of the GNU Lesser General Public License as published
|
|
|
8 * by the Free Software Foundation; either version 2.1 of the License, or
|
|
|
9 * (at your option) any later version.
|
|
|
10 *
|
|
|
11 * This library is distributed in the hope that it will be useful, but
|
|
|
12 * WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
|
13 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
|
|
|
14 * Lesser General Public License for more details.
|
|
|
15 *
|
|
|
16 * You should have received a copy of the GNU Lesser General Public
|
|
|
17 * License along with this library; if not, write to the Free Software
|
|
|
18 * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301
|
|
|
19 * USA
|
|
|
20 *
|
|
|
21 * Martin Lowinski <lowinski [at] de [dot] ibm [ibm] com>
|
|
|
22 * Dirk Herrendoerfer <d.herrendoerfer [at] de [dot] ibm [dot] com>
|
|
|
23 * SPE code based on research by:
|
|
|
24 * Rene Becker
|
|
|
25 * Thimo Emmerich
|
|
|
26 */
|
|
|
27
|
|
|
28 #include "spu_common.h"
|
|
|
29
|
|
|
30 #include <spu_intrinsics.h>
|
|
|
31 #include <spu_mfcio.h>
|
|
|
32 #include <stdio.h>
|
|
|
33 #include <string.h>
|
|
|
34
|
|
|
35 // Debugging
|
|
|
36 //#define DEBUG
|
|
|
37
|
|
|
38 #ifdef DEBUG
|
|
|
39 #define deprintf(fmt, args... ) \
|
|
|
40 fprintf( stdout, fmt, ##args ); \
|
|
|
41 fflush( stdout );
|
|
|
42 #else
|
|
|
43 #define deprintf( fmt, args... )
|
|
|
44 #endif
|
|
|
45
|
|
|
46 void cpy_to_fb(unsigned int);
|
|
|
47
|
|
|
48 /* fb_writer_spu parms */
|
|
|
49 static volatile struct fb_writer_parms_t parms __attribute__ ((aligned(128)));
|
|
|
50
|
|
|
51 /* Code running on SPU */
|
|
|
52 int main(unsigned long long spe_id __attribute__ ((unused)), unsigned long long argp __attribute__ ((unused)))
|
|
|
53 {
|
|
|
54 deprintf("[SPU] fb_writer_spu is up... (on SPE #%llu)\n", spe_id);
|
|
|
55 uint32_t ea_mfc, mbox;
|
|
|
56 // send ready message
|
|
|
57 spu_write_out_mbox(SPU_READY);
|
|
|
58
|
|
|
59 while (1) {
|
|
|
60 /* Check mailbox */
|
|
|
61 mbox = spu_read_in_mbox();
|
|
|
62 deprintf("[SPU] Message is %u\n", mbox);
|
|
|
63 switch (mbox) {
|
|
|
64 case SPU_EXIT:
|
|
|
65 deprintf("[SPU] fb_writer goes down...\n");
|
|
|
66 return 0;
|
|
|
67 case SPU_START:
|
|
|
68 break;
|
|
|
69 default:
|
|
|
70 deprintf("[SPU] Cannot handle message\n");
|
|
|
71 continue;
|
|
|
72 }
|
|
|
73
|
|
|
74 /* Tag Manager setup */
|
|
|
75 unsigned int tags;
|
|
|
76 tags = mfc_multi_tag_reserve(5);
|
|
|
77 if (tags == MFC_TAG_INVALID) {
|
|
|
78 deprintf("[SPU] Failed to reserve mfc tags on fb_writer\n");
|
|
|
79 return 0;
|
|
|
80 }
|
|
|
81
|
|
|
82 /* Framebuffer parms */
|
|
|
83 ea_mfc = spu_read_in_mbox();
|
|
|
84 deprintf("[SPU] Message on fb_writer is %u\n", ea_mfc);
|
|
|
85 spu_mfcdma32(&parms, (unsigned int)ea_mfc,
|
|
|
86 sizeof(struct fb_writer_parms_t), tags,
|
|
|
87 MFC_GET_CMD);
|
|
|
88 deprintf("[SPU] argp = %u\n", (unsigned int)argp);
|
|
|
89 DMA_WAIT_TAG(tags);
|
|
|
90
|
|
|
91 /* Copy parms->data to framebuffer */
|
|
|
92 deprintf("[SPU] Copying to framebuffer started\n");
|
|
|
93 cpy_to_fb(tags);
|
|
|
94 deprintf("[SPU] Copying to framebuffer done!\n");
|
|
|
95
|
|
|
96 mfc_multi_tag_release(tags, 5);
|
|
|
97 deprintf("[SPU] fb_writer_spu... done!\n");
|
|
|
98 /* Send FIN msg */
|
|
|
99 spu_write_out_mbox(SPU_FIN);
|
|
|
100 }
|
|
|
101
|
|
|
102 return 0;
|
|
|
103 }
|
|
|
104
|
|
|
105 void cpy_to_fb(unsigned int tag_id_base)
|
|
|
106 {
|
|
|
107 unsigned int i;
|
|
|
108 unsigned char current_buf;
|
|
|
109 uint8_t *in = parms.data;
|
|
|
110
|
|
|
111 /* Align fb pointer which was centered before */
|
|
|
112 uint8_t *fb =
|
|
|
113 (unsigned char *)((unsigned int)parms.center & 0xFFFFFFF0);
|
|
|
114
|
|
|
115 uint32_t bounded_input_height = parms.bounded_input_height;
|
|
|
116 uint32_t bounded_input_width = parms.bounded_input_width;
|
|
|
117 uint32_t fb_pixel_size = parms.fb_pixel_size;
|
|
|
118
|
|
|
119 uint32_t out_line_stride = parms.out_line_stride;
|
|
|
120 uint32_t in_line_stride = parms.in_line_stride;
|
|
|
121 uint32_t in_line_size = bounded_input_width * fb_pixel_size;
|
|
|
122
|
|
|
123 current_buf = 0;
|
|
|
124
|
|
|
125 /* Local store buffer */
|
|
|
126 static volatile uint8_t buf[4][BUFFER_SIZE]
|
|
|
127 __attribute__ ((aligned(128)));
|
|
|
128 /* do 4-times multibuffering using DMA list, process in two steps */
|
|
|
129 for (i = 0; i < bounded_input_height >> 2; i++) {
|
|
|
130 /* first buffer */
|
|
|
131 DMA_WAIT_TAG(tag_id_base + 1);
|
|
|
132 // retrieve buffer
|
|
|
133 spu_mfcdma32(buf[0], (unsigned int)in, in_line_size,
|
|
|
134 tag_id_base + 1, MFC_GETB_CMD);
|
|
|
135 DMA_WAIT_TAG(tag_id_base + 1);
|
|
|
136 // store buffer
|
|
|
137 spu_mfcdma32(buf[0], (unsigned int)fb, in_line_size,
|
|
|
138 tag_id_base + 1, MFC_PUTB_CMD);
|
|
|
139 in += in_line_stride;
|
|
|
140 fb += out_line_stride;
|
|
|
141 deprintf("[SPU] 1st buffer copied in=0x%x, fb=0x%x\n", in,
|
|
|
142 fb);
|
|
|
143
|
|
|
144 /* second buffer */
|
|
|
145 DMA_WAIT_TAG(tag_id_base + 2);
|
|
|
146 // retrieve buffer
|
|
|
147 spu_mfcdma32(buf[1], (unsigned int)in, in_line_size,
|
|
|
148 tag_id_base + 2, MFC_GETB_CMD);
|
|
|
149 DMA_WAIT_TAG(tag_id_base + 2);
|
|
|
150 // store buffer
|
|
|
151 spu_mfcdma32(buf[1], (unsigned int)fb, in_line_size,
|
|
|
152 tag_id_base + 2, MFC_PUTB_CMD);
|
|
|
153 in += in_line_stride;
|
|
|
154 fb += out_line_stride;
|
|
|
155 deprintf("[SPU] 2nd buffer copied in=0x%x, fb=0x%x\n", in,
|
|
|
156 fb);
|
|
|
157
|
|
|
158 /* third buffer */
|
|
|
159 DMA_WAIT_TAG(tag_id_base + 3);
|
|
|
160 // retrieve buffer
|
|
|
161 spu_mfcdma32(buf[2], (unsigned int)in, in_line_size,
|
|
|
162 tag_id_base + 3, MFC_GETB_CMD);
|
|
|
163 DMA_WAIT_TAG(tag_id_base + 3);
|
|
|
164 // store buffer
|
|
|
165 spu_mfcdma32(buf[2], (unsigned int)fb, in_line_size,
|
|
|
166 tag_id_base + 3, MFC_PUTB_CMD);
|
|
|
167 in += in_line_stride;
|
|
|
168 fb += out_line_stride;
|
|
|
169 deprintf("[SPU] 3rd buffer copied in=0x%x, fb=0x%x\n", in,
|
|
|
170 fb);
|
|
|
171
|
|
|
172 /* fourth buffer */
|
|
|
173 DMA_WAIT_TAG(tag_id_base + 4);
|
|
|
174 // retrieve buffer
|
|
|
175 spu_mfcdma32(buf[3], (unsigned int)in, in_line_size,
|
|
|
176 tag_id_base + 4, MFC_GETB_CMD);
|
|
|
177 DMA_WAIT_TAG(tag_id_base + 4);
|
|
|
178 // store buffer
|
|
|
179 spu_mfcdma32(buf[3], (unsigned int)fb, in_line_size,
|
|
|
180 tag_id_base + 4, MFC_PUTB_CMD);
|
|
|
181 in += in_line_stride;
|
|
|
182 fb += out_line_stride;
|
|
|
183 deprintf("[SPU] 4th buffer copied in=0x%x, fb=0x%x\n", in,
|
|
|
184 fb);
|
|
|
185 deprintf("[SPU] Loop #%i, bounded_input_height=%i\n", i,
|
|
|
186 bounded_input_height >> 2);
|
|
|
187 }
|
|
|
188 DMA_WAIT_TAG(tag_id_base + 2);
|
|
|
189 DMA_WAIT_TAG(tag_id_base + 3);
|
|
|
190 DMA_WAIT_TAG(tag_id_base + 4);
|
|
|
191 }
|
|
|
192
|
|
|
193
|
