Add two running state machines.
This commit is contained in:
parent
73195267cb
commit
c17a9b1018
44
src/main.c
44
src/main.c
@ -32,12 +32,11 @@ typedef struct Frame
|
|||||||
|
|
||||||
static Frame frames[FRAMES] = {0};
|
static Frame frames[FRAMES] = {0};
|
||||||
|
|
||||||
static void vga_program_init(PIO pio, uint sm, uint offset)
|
static void vga_pixel_program_init(PIO pio, uint sm, uint offset)
|
||||||
{
|
{
|
||||||
// magic definition of the called function?
|
// magic definition of the called function?
|
||||||
pio_sm_config c = vga_free_run_program_get_default_config(offset);
|
pio_sm_config c = vga_free_run_program_get_default_config(offset);
|
||||||
sm_config_set_out_pins(&c, 22, 1);
|
sm_config_set_out_pins(&c, 22, 1);
|
||||||
|
|
||||||
pio_gpio_init(pio, 22);
|
pio_gpio_init(pio, 22);
|
||||||
pio_sm_set_consecutive_pindirs(pio, sm, 22, 1, true);
|
pio_sm_set_consecutive_pindirs(pio, sm, 22, 1, true);
|
||||||
|
|
||||||
@ -53,6 +52,20 @@ static void vga_program_init(PIO pio, uint sm, uint offset)
|
|||||||
pio_sm_set_enabled(pio, sm, true);
|
pio_sm_set_enabled(pio, sm, true);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
static void vga_sync_program_init(PIO pio, uint sm, uint offset)
|
||||||
|
{
|
||||||
|
pio_sm_config config = vga_sync_program_get_default_config(offset);
|
||||||
|
sm_config_set_out_pins(&config, 20, 2);
|
||||||
|
pio_gpio_init(pio, 20);
|
||||||
|
pio_sm_set_consecutive_pindirs(pio, sm, 20, 2, true);
|
||||||
|
|
||||||
|
pio_sm_init(pio, sm, offset, &config);
|
||||||
|
|
||||||
|
pio_sm_set_clkdiv_int_frac(pio, sm, 1, 0);
|
||||||
|
|
||||||
|
pio_sm_set_enabled(pio, sm, true);
|
||||||
|
}
|
||||||
|
|
||||||
int main()
|
int main()
|
||||||
{
|
{
|
||||||
// main clock = VCO / divider1 / divider2 = 126MHz
|
// main clock = VCO / divider1 / divider2 = 126MHz
|
||||||
@ -60,12 +73,6 @@ int main()
|
|||||||
|
|
||||||
stdio_init_all();
|
stdio_init_all();
|
||||||
|
|
||||||
#if 0
|
|
||||||
const uint LED_PIN = PICO_DEFAULT_LED_PIN;
|
|
||||||
gpio_init(LED_PIN);
|
|
||||||
gpio_set_dir(LED_PIN, GPIO_OUT);
|
|
||||||
#endif
|
|
||||||
|
|
||||||
// "draw" an horizontal dotted line (?)
|
// "draw" an horizontal dotted line (?)
|
||||||
for (unsigned int c = 0; c < 20; c += 3)
|
for (unsigned int c = 0; c < 20; c += 3)
|
||||||
{
|
{
|
||||||
@ -76,18 +83,31 @@ int main()
|
|||||||
frames[0].data[80 * 128 + 20 + c] = 0x99;
|
frames[0].data[80 * 128 + 20 + c] = 0x99;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
// PIO and state machines
|
||||||
PIO pio = pio0;
|
PIO pio = pio0;
|
||||||
uint offset = pio_add_program(pio, &vga_free_run_program);
|
|
||||||
uint sm = pio_claim_unused_sm(pio, true);
|
sleep_ms(5000);
|
||||||
vga_program_init(pio, sm, offset);
|
|
||||||
|
// VGA pixel program
|
||||||
|
uint offset0 = pio_add_program(pio, &vga_free_run_program);
|
||||||
|
uint sm0 = pio_claim_unused_sm(pio, true);
|
||||||
|
printf("Starting VGA pixel machine on %u...\n", sm0);
|
||||||
|
vga_pixel_program_init(pio, sm0, offset0);
|
||||||
|
|
||||||
|
// VGA sync program
|
||||||
|
uint offset1 = pio_add_program(pio, &vga_sync_program);
|
||||||
|
uint sm1 = pio_claim_unused_sm(pio, true);
|
||||||
|
printf("Starting VGA sync machine on %u...\n", sm1);
|
||||||
|
vga_sync_program_init(pio, sm1, offset1);
|
||||||
|
|
||||||
printf("Welcome.\n");
|
printf("Welcome.\n");
|
||||||
|
|
||||||
|
// feed pixel program
|
||||||
while (true)
|
while (true)
|
||||||
{
|
{
|
||||||
for (size_t i = 0; i < sizeof(frames[0].data); ++i)
|
for (size_t i = 0; i < sizeof(frames[0].data); ++i)
|
||||||
{
|
{
|
||||||
pio_sm_put_blocking(pio, sm, frames[0].data[i]);
|
pio_sm_put_blocking(pio, sm0, frames[0].data[i]);
|
||||||
}
|
}
|
||||||
printf(".");
|
printf(".");
|
||||||
sleep_ms(1000);
|
sleep_ms(1000);
|
||||||
|
14
src/vga.pio
14
src/vga.pio
@ -1,9 +1,19 @@
|
|||||||
.program vga_free_run
|
.program vga_free_run
|
||||||
|
|
||||||
|
entrypoint_vga_free_run:
|
||||||
entrypoint:
|
|
||||||
pull
|
pull
|
||||||
loop:
|
loop:
|
||||||
out pins, 1 [2]
|
out pins, 1 [2]
|
||||||
jmp loop
|
jmp loop
|
||||||
|
|
||||||
|
.program vga_sync
|
||||||
|
|
||||||
|
entrypoint_vga_sync:
|
||||||
|
loop:
|
||||||
|
set x, 31
|
||||||
|
mov osr, x
|
||||||
|
out pins, 1 [30]
|
||||||
|
set x, 0
|
||||||
|
mov osr, x
|
||||||
|
out pins, 1 [30]
|
||||||
|
jmp loop
|
||||||
|
Loading…
Reference in New Issue
Block a user