Documentation + Fancy demo drawing with sine wave.

This commit is contained in:
giomba 2022-12-02 20:27:21 +01:00
parent 4f26826d4b
commit ac5c39ff0c
1 changed files with 99 additions and 35 deletions

View File

@ -17,21 +17,26 @@
#include <stdint.h> #include <stdint.h>
#include <stdio.h> #include <stdio.h>
#include <string.h> #include <string.h>
#include <math.h>
#include <stdlib.h>
#include "vga.pio.h" #include "vga.pio.h"
#define FRAMES 2 #define HPIXEL 640 // number of pixels displayed horizontally
#define VPIXEL 480 // number of pixels displayed vertically
#define BPP 1 // bits per pixel
#define HPIXEL 640 #define VSPULSE 3 // number of lines during the vertical sync pulse
#define VPIXEL 480 #define VBBLANK 16 // number of lines of the initial back porch blanking period
#define BPP 1 #define VFBLANK 1 // number of lines of the final front porch blanking period
typedef struct Frame // Frame buffer.
{ // Due to limitations in program space of PIO interface,
uint8_t data[HPIXEL * VPIXEL * BPP / 8]; // additional blank lines are needed and sent to the display,
} Frame; // to fill the vertical blanking interval at top and bottom
// of the display
static Frame frames[FRAMES] = {0}; // (at 1BPP, this wastes about 1k)
uint8_t frame[HPIXEL * (VPIXEL + VBBLANK + VFBLANK) * BPP / 8] = {0};
static void vga_pixel_program_init(PIO pio, uint sm, uint offset) static void vga_pixel_program_init(PIO pio, uint sm, uint offset)
{ {
@ -125,18 +130,9 @@ typedef struct PIORun
uint sm; //< executing SM uint sm; //< executing SM
} PIORun; } PIORun;
PIORun *vga_pixel_ptr = NULL; static PIORun *vga_pixel_ptr = NULL;
void new_frame_handler(void) static unsigned long int frame_counter = 0;
{
if (vga_pixel_ptr && dma_ready)
{
pio_sm_put_blocking(vga_pixel_ptr->pio, vga_pixel_ptr->sm, 0);
dma_channel_set_read_addr(dma_channel, &frames[0].data[4], true);
}
pio_interrupt_clear(pio0_hw, 1);
}
void dma_handler(void) void dma_handler(void)
{ {
@ -144,14 +140,45 @@ void dma_handler(void)
dma_hw->ints0 = 1 << dma_channel; dma_hw->ints0 = 1 << dma_channel;
} }
bool valid_coord(uint16_t x, uint16_t y)
{
if (x < 0 || x >= HPIXEL)
return false;
if (y < 0 || y >= VPIXEL)
return false;
return true;
}
void set_pixel(uint16_t x, uint16_t y) void set_pixel(uint16_t x, uint16_t y)
{ {
frames[0].data[y * 80 + x / 8] |= (1 << x % 8); // ignore out of frame pixels
if (!valid_coord(x, y))
return;
// Since there is not much space in PIO program memory,
// it is not possible to set the last pixel of a line,
// because there is not enough program space to unset it
// in the hardware, and, if left set, will mess with
// the sync signals.
if (x == 639)
return;
// skip wasted blanking lines
// (see frame struct declaration)
y += VBBLANK + VFBLANK;
// set bit
frame[y * 80 + x / 8] |= (1 << x % 8);
} }
void clear_pixel(uint16_t x, uint16_t y) void clear_pixel(uint16_t x, uint16_t y)
{ {
frames[0].data[y * 80 + x / 8] &= ~(1 << x % 8); if (!valid_coord(x, y))
return;
y += VBBLANK + VFBLANK;
frame[y * 80 + x / 8] &= ~(1 << x % 8);
} }
void draw_simple_line(uint16_t x, uint16_t y, uint16_t len, bool horizontal) void draw_simple_line(uint16_t x, uint16_t y, uint16_t len, bool horizontal)
@ -165,6 +192,31 @@ void draw_simple_line(uint16_t x, uint16_t y, uint16_t len, bool horizontal)
} }
} }
void new_frame_handler(void)
{
if (vga_pixel_ptr && dma_ready)
{
// Explicitly put the first uint32_t word in the FIFO,
// because, when PIO pulls data for the first time,
// and its FIFO is empty, the DMA controller takes "a while"
// to put the first word and keep up with the transfer,
// making the whole frame a bit offset to the right.
// Since front porch is very short, even the smallest delay,
// may disrupt the timing.
// Also note: despite the "blocking put", when this interrupt
// is serviced, PIO FIFO is always empty, so in practice
// this will never block.
pio_sm_put_blocking(vga_pixel_ptr->pio, vga_pixel_ptr->sm, 0);
// Start DMA (but skip the initial word, which has been put manually)
dma_channel_set_read_addr(dma_channel, &frame[4], true);
}
frame_counter++;
pio_interrupt_clear(pio0_hw, 1);
}
int main() int main()
{ {
setup_clocks(); setup_clocks();
@ -172,28 +224,29 @@ int main()
sleep_ms(1000); sleep_ms(1000);
// clear frame buffer // clear frame buffer
memset(&frames[0].data[0], 0, sizeof(frames[0].data)); memset(&frame[0], 0, sizeof(frame));
// draw a cross // draw a cross
// horizontal lines // horizontal lines
for (uint16_t x = 0; x < 639; ++x) // last pixel high -> bad for (uint16_t x = 0; x < 640; ++x)
{ {
if ((x / 32) % 2 == 0) if ((x / 32) % 2 == 0)
set_pixel(x, 20); set_pixel(x, 0);
if ((x / 32) % 2 == 1) if ((x / 32) % 2 == 1)
set_pixel(x, 23); set_pixel(x, 2);
set_pixel(x, 239); set_pixel(x, 239);
set_pixel(x, 479); set_pixel(x, 479);
} }
// vertical lines // vertical lines
for (uint16_t y = 21; y < 480; ++y) for (uint16_t y = 0; y < 480; ++y)
{ {
set_pixel(0 + ((y - 20) / 10) * 4, y); set_pixel(0 + (y / 10) * 4, y);
set_pixel(0, y); set_pixel(0, y);
set_pixel(319, y); set_pixel(319, y);
// rightmost pixels can't be set, see description
set_pixel(638, y); set_pixel(638, y);
} }
// try to find strangeness using stairs // try to find strangeness using stairs
for (uint16_t x = 0; x < 639; ++x) for (uint16_t x = 0; x < 640; ++x)
{ {
set_pixel(x, (x / 32) * 4 + 120); set_pixel(x, (x / 32) * 4 + 120);
} }
@ -203,8 +256,6 @@ int main()
draw_simple_line(100, 104, 8, true); draw_simple_line(100, 104, 8, true);
draw_simple_line(100, 108, 8, true); draw_simple_line(100, 108, 8, true);
clear_pixel(639, 479);
// Running programs on PIO // Running programs on PIO
PIORun vga_hsync, vga_vsync, vga_pixel; PIORun vga_hsync, vga_vsync, vga_pixel;
vga_hsync.pio = vga_vsync.pio = vga_pixel.pio = pio0; vga_hsync.pio = vga_vsync.pio = vga_pixel.pio = pio0;
@ -264,8 +315,11 @@ int main()
irq_set_exclusive_handler(DMA_IRQ_0, dma_handler); irq_set_exclusive_handler(DMA_IRQ_0, dma_handler);
irq_set_enabled(DMA_IRQ_0, true); irq_set_enabled(DMA_IRQ_0, true);
dma_channel_configure(dma_channel, &dma_config, &pio0_hw->txf[2], &frames[0].data[0], 9600 - 1, // -1 because first word is manually injected
true); // before the first DMA request, in order to
// avoid any possible delay
dma_channel_configure(dma_channel, &dma_config, &pio0_hw->txf[2], &frame[0],
HPIXEL * (VPIXEL + VBBLANK + VFBLANK) / 32 - 1, true);
dma_ready = true; dma_ready = true;
printf("OK\n"); printf("OK\n");
@ -273,5 +327,15 @@ int main()
printf("Now running.\n"); printf("Now running.\n");
for (;;) for (;;)
tight_loop_contents(); {
// fancy drawings
const uint16_t fc = frame_counter;
const uint16_t x = fc % 640;
const uint16_t y = 239 + 100 * (abs(320 - x) / 640.0) * sin((fc % 640) / 12.738);
if ((fc / 640) % 2)
set_pixel(x, y);
else
clear_pixel(x, y);
sleep_ms(5);
}
} }