]> Joshua Wise's Git repositories - mandelfpga.git/blob - Main.v
Cut 1 at triple pumping the pipeline
[mandelfpga.git] / Main.v
1 /* 
2  * MandelFPGA
3  * by Joshua Wise and Chris Lu
4  * 
5  * An implementation of a pipelined algorithm to calculate the Mandelbrot set
6  * in real time on an FPGA.
7  */
8
9 `define XRES 640
10 `define YRES 480
11 `define WHIRRRRR 27
12
13 module SyncGen(
14         input pixclk,
15         output reg vs, hs,
16         output reg [11:0] xout = `WHIRRRRR, yout = 0,
17         output wire [11:0] xoutreal, youtreal,
18         output reg border);
19         
20         reg [11:0] x = 0, y = 0;        // Used for generating border and timing.
21         assign xoutreal = x;
22         assign youtreal = y;
23         
24         parameter XFPORCH = 16;
25         parameter XSYNC = 96;
26         parameter XBPORCH = 48;
27         
28         parameter YFPORCH = 10;
29         parameter YSYNC = 2;
30         parameter YBPORCH = 29;
31
32         always @(posedge pixclk)
33         begin
34                 if (x >= (`XRES + XFPORCH + XSYNC + XBPORCH))
35                 begin
36                         if (y >= (`YRES + YFPORCH + YSYNC + YBPORCH))
37                                 y <= 0;
38                         else
39                                 y <= y + 1;
40                         x <= 0;
41                 end else
42                         x <= x + 1;
43                         
44                 if (xout >= (`XRES + XFPORCH + XSYNC + XBPORCH))
45                 begin
46                         if (yout >= (`YRES + YFPORCH + YSYNC + YBPORCH))
47                                 yout <= 0;
48                         else
49                                 yout <= yout + 1;
50                         xout <= 0;
51                 end else
52                         xout <= xout + 1;
53                 hs <= (x >= (`XRES + XFPORCH)) && (x < (`XRES + XFPORCH + XSYNC));
54                 vs <= (y >= (`YRES + YFPORCH)) && (y < (`YRES + YFPORCH + YSYNC));
55                 border <= (x > `XRES) || (y > `YRES);
56         end
57 endmodule
58
59 // bits: 1.12
60
61 module NaiveMultiplier(
62         input clk,
63         input [12:0] x, y,
64         input xsign, ysign,
65         output reg [12:0] out,
66         output reg sign,
67         output reg [1:0] ovf);
68
69         always @(posedge clk)
70         begin
71                 {ovf,out} <=
72                         (((y[12] ? (x     ) : 0)  +
73                           (y[11] ? (x >> 1) : 0)  +
74                           (y[10] ? (x >> 2) : 0)  +
75                           (y[9]  ? (x >> 3) : 0)) +
76                          ((y[8]  ? (x >> 4) : 0)  +
77                           (y[7]  ? (x >> 5) : 0)  +
78                           (y[6]  ? (x >> 6) : 0)))+
79                         (((y[5]  ? (x >> 7) : 0)  +
80                           (y[4]  ? (x >> 8) : 0)  +
81                           (y[3]  ? (x >> 9) : 0)) +
82                          ((y[2]  ? (x >> 10): 0)  +
83                           (y[1]  ? (x >> 11): 0)  +
84                           (y[0]  ? (x >> 12): 0)));
85                 sign <= xsign ^ ysign;
86         end
87
88 endmodule
89
90 module Multiplier(
91         input clk,
92         input [12:0] x, y,
93         input xsign, ysign,
94         output wire [12:0] out,
95         output wire sign,
96         output wire [1:0] overflow);
97
98         NaiveMultiplier nm(clk, x, y, xsign, ysign, out, sign, overflow);
99
100 endmodule
101
102 module MandelUnit(
103         input clk,
104         input [12:0] x, y,
105         input xsign, ysign,
106         input [14:0] r, i,
107         input rsign, isign,
108         input [7:0] ibail, icuriter,
109         output reg [12:0] xout, yout,
110         output reg xsout, ysout,
111         output reg [14:0] rout, iout,
112         output reg rsout, isout,
113         output reg [7:0] obail, ocuriter);
114
115         wire [14:0] r2, i2, ri, diff;
116         wire [15:0] twocdiff;
117         wire r2sign, i2sign, risign, dsign;
118         wire [16:0] bigsum;
119         wire bigsum_ovf, rin_ovf, iin_ovf, throwaway;
120
121         reg [12:0] xd, yd;
122         reg rd, id;
123         reg xsd, ysd;
124         reg [7:0] ibaild, curiterd;
125
126         assign ri[0] = 0;
127
128         Multiplier r2m(clk, r[12:0], r[12:0], rsign, rsign, r2[12:0], r2sign, r2[14:13]);
129         Multiplier i2m(clk, i[12:0], i[12:0], isign, isign, i2[12:0], i2sign, i2[14:13]);
130         Multiplier rim(clk, r[12:0], i[12:0], rsign, isign, ri[13:1], risign, {throwaway,ri[14]});
131
132         assign bigsum = r2 + i2;
133         assign bigsum_ovf = bigsum[16] | bigsum[15] | bigsum[14];
134         assign rin_ovf = rd;
135         assign iin_ovf = id;
136         assign twocdiff = r2 - i2;
137         assign diff = twocdiff[15] ? -twocdiff : twocdiff;
138         assign dsign = twocdiff[15];
139
140         always @ (posedge clk)
141         begin
142                 xd <= x;
143                 yd <= y;
144                 xsd <= xsign;
145                 ysd <= ysign;
146                 xout <= xd;
147                 yout <= yd;
148                 xsout <= xsd;
149                 ysout <= ysd;
150                 ibaild <= ibail;
151                 curiterd <= icuriter;
152                 rd <= r[13] | r[14];
153                 id <= i[13] | i[14];
154
155                 if (xsd ^ dsign) begin
156                         if (diff > xd) begin
157                                 rout <= diff - xd;
158                                 rsout <= dsign;
159                         end else begin
160                                 rout <= xd - diff;
161                                 rsout <= xsd;
162                         end
163                 end else begin
164                         rout <= diff + xd;
165                         rsout <= xsd;
166                 end
167                 
168                 if (ysd ^ risign) begin
169                         if (ri > yd) begin
170                                 iout <= ri - yd;
171                                 isout <= risign;
172                         end else begin
173                                 iout <= yd - ri;
174                                 isout <= ysd;
175                         end
176                 end else begin
177                         iout <= ri + yd;
178                         isout <= ysd;
179                 end
180                 
181                 // If we haven't bailed out, and we meet any of the bailout conditions,
182                 // bail out now.  Otherwise, leave the bailout at whatever it was before.
183                 if ((ibaild == 255) && (bigsum_ovf | rin_ovf | iin_ovf))
184                         obail <= curiterd;
185                 else
186                         obail <= ibaild;
187                 ocuriter <= curiterd + 8'b1;
188         end
189
190 endmodule
191
192 module Mandelbrot(
193         input mclk,
194         input pixclk,
195         input [11:0] x, y,
196         input [13:0] xofs, yofs,
197         input [7:0] colorofs,
198         input [2:0] scale,
199         output reg [2:0] red, green, output reg [1:0] blue);
200
201 `define MAXOUTN 11
202         
203         wire [12:0] rx, ry;
204         wire [13:0] nx, ny;
205         wire rxsign, rysign;
206         
207         assign nx = x + xofs;
208         assign ny = y + yofs;
209         assign rx = (nx[13] ? -nx[12:0] : nx[12:0]) << scale;
210         assign rxsign = nx[13];
211         assign ry = (ny[13] ? -ny[12:0] : ny[12:0]) << scale;
212         assign rysign = ny[13];
213         
214
215         wire [14:0] mr[`MAXOUTN:0], mi[`MAXOUTN:0];
216         wire mrs[`MAXOUTN:0], mis[`MAXOUTN:0];
217         wire [7:0] mb[`MAXOUTN:0];
218         wire [12:0] xprop[`MAXOUTN:0], yprop[`MAXOUTN:0];
219         wire xsprop[`MAXOUTN:0], ysprop[`MAXOUTN:0];
220         wire [7:0] curiter[`MAXOUTN:0];
221         
222         wire [14:0] initx, inity, initr, initi;
223         wire [7:0] initci, initb;
224         wire initxs, initys, initrs, initis;
225         
226         // Values after the number of iterations denoted by the subscript.
227         reg [14:0] stagex [2:1], stagey [2:1], stager [2:1], stagei [2:1];
228         reg [7:0] stageci [2:1], stageb [2:1];
229         reg stagexs [2:1], stageys [2:1], stagers [2:1], stageis [2:1];
230         
231         reg [2:0] state = 3'b001;       // One-hot encoded state.
232         
233         // On pixclk = 1,
234         //    A new value to be loaded comes in, and a value in need of loopback comes out.
235         // On pixclk = 0,
236         //    A new value in need of loopback comes in, and a completed value comes out.
237         
238         assign initx = state[0] ? rx :
239                        state[1] ? stagex[1] :
240                        stagex[2];
241         assign inity = state[0] ? ry :
242                        state[1] ? stagey[1] :
243                        stagey[2];
244         assign initr = state[0] ? rx :
245                        state[1] ? stager[1] :
246                        stager[2];
247         assign initi = state[0] ? ry :
248                        state[1] ? stagei[1] :
249                        stagei[2];
250         assign initxs = state[0] ? rxsign :
251                         state[1] ? stagexs[1] :
252                         stagexs[2];
253         assign initys = state[0] ? rysign :
254                         state[1] ? stageys[1] :
255                         stageys[2];
256         assign initrs = state[0] ? rxsign :
257                         state[1] ? stagers[1] :
258                         stagers[2];
259         assign initis = state[0] ? rysign :
260                         state[1] ? stageis[1] :
261                         stageis[2];
262         assign initb = state[0] ? 8'b11111111 :
263                        state[1] ? stageb[1] :
264                        stageb[2];
265         assign initci = state[0] ? 8'b00000000 :
266                         state[1] ? stageb[1] : 
267                         stageb[2];
268         
269         reg [7:0] out;
270         reg typethea = 0;       // Whether we have typed the A.
271         reg statekick = 0;      // State needs to be kicked back to 3'b010 on the next mclk.
272
273         // This is guaranteed to converge after two pixclks.
274         //always @(negedge mclk)
275         //      if (pixclk && !typethea) begin
276         //              typethea <= 1;
277         //              statekick <= 1;
278         //      end else if (typethea) begin // This is the edge of the falling anus.
279         //              typethea <= 0;
280         //              statekick <= 0;
281         //      end
282         
283         always @(posedge mclk)
284         begin
285                 // Data output handling
286                 if (state[0]) begin
287                         {red, green, blue} <= {out[0],out[3],out[6],out[1],out[4],out[7],out[2],out[5]};
288                 end
289                 if (state[2]) begin
290                         out <= ~mb[`MAXOUTN] + colorofs;
291                 end
292                 
293                 if (state[1]) begin             // PnR0 in, PnR2 out
294                         stagex[2] <= xprop[`MAXOUTN];
295                         stagey[2] <= yprop[`MAXOUTN];
296                         stager[2] <= mr[`MAXOUTN];
297                         stagei[2] <= mi[`MAXOUTN];
298                         stagexs[2] <= xsprop[`MAXOUTN];
299                         stageys[2] <= ysprop[`MAXOUTN];
300                         stagers[2] <= mrs[`MAXOUTN];
301                         stageis[2] <= mis[`MAXOUTN];
302                         stageb[2] <= mb[`MAXOUTN];
303                         stageci[2] <= curiter[`MAXOUTN];
304                 end
305                 
306                 if (state[0]) begin     // PnR2 in, PnR1 out
307                         stagex[1] <= xprop[`MAXOUTN];
308                         stagey[1] <= yprop[`MAXOUTN];
309                         stager[1] <= mr[`MAXOUTN];
310                         stagei[1] <= mi[`MAXOUTN];
311                         stagexs[1] <= xsprop[`MAXOUTN];
312                         stageys[1] <= ysprop[`MAXOUTN];
313                         stagers[1] <= mrs[`MAXOUTN];
314                         stageis[1] <= mis[`MAXOUTN];
315                         stageb[1] <= mb[`MAXOUTN];
316                         stageci[1] <= curiter[`MAXOUTN];
317                 end
318                 
319                 if (statekick)          // If a pixclk has happened, the state should be reset.
320                         state <= 3'b010;
321                 else                                            // Otherwise, just poke it forward.
322                         state <= {state[1], state[0], state[2]};
323         end
324
325         MandelUnit mu0(
326                 mclk,
327                 initx, inity, initxs, initys,
328                 initr, initi, initrs, initis,
329                 initb, initci,
330                 xprop[0], yprop[0], xsprop[0], ysprop[0],
331                 mr[0], mi[0], mrs[0], mis[0],
332                 mb[0], curiter[0]);
333
334         MandelUnit mu1(mclk,
335                 xprop[0], yprop[0], xsprop[0], ysprop[0], mr[0], mi[0], mrs[0], mis[0], mb[0], curiter[0],
336                 xprop[1], yprop[1], xsprop[1], ysprop[1], mr[1], mi[1], mrs[1], mis[1], mb[1], curiter[1]);
337         MandelUnit mu2(mclk,
338                 xprop[1], yprop[1], xsprop[1], ysprop[1], mr[1], mi[1], mrs[1], mis[1], mb[1], curiter[1],
339                 xprop[2], yprop[2], xsprop[2], ysprop[2], mr[2], mi[2], mrs[2], mis[2], mb[2], curiter[2]);
340         MandelUnit mu3(mclk,
341                 xprop[2], yprop[2], xsprop[2], ysprop[2], mr[2], mi[2], mrs[2], mis[2], mb[2], curiter[2],
342                 xprop[3], yprop[3], xsprop[3], ysprop[3], mr[3], mi[3], mrs[3], mis[3], mb[3], curiter[3]);
343         MandelUnit mu4(mclk,
344                 xprop[3], yprop[3], xsprop[3], ysprop[3], mr[3], mi[3], mrs[3], mis[3], mb[3], curiter[3],
345                 xprop[4], yprop[4], xsprop[4], ysprop[4], mr[4], mi[4], mrs[4], mis[4], mb[4], curiter[4]);
346         MandelUnit mu5(mclk,
347                 xprop[4], yprop[4], xsprop[4], ysprop[4], mr[4], mi[4], mrs[4], mis[4], mb[4], curiter[4],
348                 xprop[5], yprop[5], xsprop[5], ysprop[5], mr[5], mi[5], mrs[5], mis[5], mb[5], curiter[5]);
349         MandelUnit mu6(mclk,
350                 xprop[5], yprop[5], xsprop[5], ysprop[5], mr[5], mi[5], mrs[5], mis[5], mb[5], curiter[5],
351                 xprop[6], yprop[6], xsprop[6], ysprop[6], mr[6], mi[6], mrs[6], mis[6], mb[6], curiter[6]);
352         MandelUnit mu7(mclk,
353                 xprop[6], yprop[6], xsprop[6], ysprop[6], mr[6], mi[6], mrs[6], mis[6], mb[6], curiter[6],
354                 xprop[7], yprop[7], xsprop[7], ysprop[7], mr[7], mi[7], mrs[7], mis[7], mb[7], curiter[7]);
355         MandelUnit mu8(mclk,
356                 xprop[7], yprop[7], xsprop[7], ysprop[7], mr[7], mi[7], mrs[7], mis[7], mb[7], curiter[7],
357                 xprop[8], yprop[8], xsprop[8], ysprop[8], mr[8], mi[8], mrs[8], mis[8], mb[8], curiter[8]);
358         MandelUnit mu9(mclk,
359                 xprop[8], yprop[8], xsprop[8], ysprop[8], mr[8], mi[8], mrs[8], mis[8], mb[8], curiter[8],
360                 xprop[9], yprop[9], xsprop[9], ysprop[9], mr[9], mi[9], mrs[9], mis[9], mb[9], curiter[9]);
361         MandelUnit mua(mclk,
362                 xprop[9],  yprop[9],  xsprop[9],  ysprop[9],  mr[9],  mi[9],  mrs[9],  mis[9],  mb[9], curiter[9],
363                 xprop[10], yprop[10], xsprop[10], ysprop[10], mr[10], mi[10], mrs[10], mis[10], mb[10], curiter[10]);
364         MandelUnit mub(mclk,
365                 xprop[10], yprop[10], xsprop[10], ysprop[10], mr[10], mi[10], mrs[10], mis[10], mb[10], curiter[10],
366                 xprop[11], yprop[11], xsprop[11], ysprop[11], mr[11], mi[11], mrs[11], mis[11], mb[11], curiter[11]);
367
368 endmodule
369
370 module Logo(
371         input pixclk,
372         input [11:0] x, y,
373         output wire enb,
374         output wire [2:0] red, green, output wire [1:0] blue);
375         
376         reg [1:0] logo[8191:0];
377         initial $readmemb("logo.readmemb", logo);
378         
379         assign enb = (x < 96) && (y < 64);
380         wire [12:0] addr = {y[5:0], x[6:0]};
381         wire [1:0] data = logo[addr];
382         assign {red, green, blue} = 
383                  (data == 2'b00) ? 8'b00000000 :
384                 ((data == 2'b01) ? 8'b00011100 :
385                 ((data == 2'b10) ? 8'b11100000 :
386                                     8'b11111111));
387 endmodule
388
389 module MandelTop(
390         input gclk, output wire dcmok,
391         output wire vs, hs,
392         output wire [2:0] red, green, output [1:0] blue,
393         input left, right, up, down, rst, cycle, logooff,
394         input [2:0] scale);
395
396
397         wire pixclk, mclk, gclk2, clk;
398         wire dcm1ok, dcm2ok;
399         assign dcmok = dcm1ok && dcm2ok;
400         
401         IBUFG typeA(.O(clk), .I(gclk));
402         
403         pixDCM dcm(                                     // CLKIN is 50MHz xtal, CLKFX_OUT is 25MHz
404                 .CLKIN_IN(clk), 
405                 .CLKFX_OUT(pixclk),
406                 .LOCKED_OUT(dcm1ok)
407                 );
408         
409         mandelDCM dcm2(
410                 .CLKIN_IN(clk),
411                 .CLKFX_OUT(mclk),
412                 .LOCKED_OUT(dcm2ok)
413                 );
414         
415         wire border;
416         wire [11:0] x, y;
417         reg [13:0] xofs = -`XRES/2, yofs = -`YRES/2;
418         reg [5:0] slowctr = 0;
419         reg [7:0] colorcycle = 0;
420         wire [11:0] realx, realy;
421         
422         wire logoenb;
423         wire [2:0] mandelr, mandelg, logor, logog;
424         wire [1:0] mandelb, logob;
425         
426         
427
428         SyncGen sync(pixclk, vs, hs, x, y, realx, realy, border);
429         Mandelbrot mandel(mclk, pixclk, x, y, xofs, yofs, cycle ? colorcycle : 0, scale, mandelr, mandelg, mandelb);
430         Logo logo(pixclk, realx, realy, logoenb, logor, logog, logob);
431         
432         assign {red,green,blue} =
433                 border ? 8'b00000000 :
434                 (!logooff && logoenb) ? {logor, logog, logob} : {mandelr, mandelg, mandelb};
435         
436         always @(posedge vs)
437         begin
438                 if (rst)
439                 begin
440                         xofs <= -`XRES/2;
441                         yofs <= -`YRES/2;
442                         colorcycle <= 0;
443                 end else begin
444                         if (up) yofs <= yofs + 1;
445                         else if (down) yofs <= yofs - 1;
446                         
447                         if (left) xofs <= xofs + 1;
448                         else if (right) xofs <= xofs - 1;
449                         
450                         if (slowctr == 0)
451                                 colorcycle <= colorcycle + 1;
452                 end
453                 
454                 if (slowctr == 12)
455                         slowctr <= 0;
456                 else
457                         slowctr <= slowctr + 1;
458         end
459 endmodule
This page took 0.044065 seconds and 4 git commands to generate.