Mercurial > ~darius > hgwebdir.cgi > modulator

annotate modulator.c @ 9:3acdebd7eec7

Find changesets by keywords (author, files, the commit message), revision number or hash, or revset expression.
Make it actually work
author Daniel O'Connor <darius@dons.net.au>
date Fri, 21 Feb 2025 17:27:22 +1030
parents 0249d0cecac4
children 98880b18bcc1
Ignore whitespace changes - Everywhere: Within whitespace: At end of lines:
rev   line source
0
a55e39064a71 First commit of code that compiles.
Daniel O'Connor <darius@dons.net.au>
parents:
diff changeset
1 /******************************************************************
a55e39064a71 First commit of code that compiles.
Daniel O'Connor <darius@dons.net.au>
parents:
diff changeset
2 *******************************************************************
a55e39064a71 First commit of code that compiles.
Daniel O'Connor <darius@dons.net.au>
parents:
diff changeset
3 **
a55e39064a71 First commit of code that compiles.
Daniel O'Connor <darius@dons.net.au>
parents:
diff changeset
4 ** This is proprietary unpublished source code, property
a55e39064a71 First commit of code that compiles.
Daniel O'Connor <darius@dons.net.au>
parents:
diff changeset
5 ** of Genesis Software. Use or disclosure without prior
a55e39064a71 First commit of code that compiles.
Daniel O'Connor <darius@dons.net.au>
parents:
diff changeset
6 ** agreement is expressly prohibited.
a55e39064a71 First commit of code that compiles.
Daniel O'Connor <darius@dons.net.au>
parents:
diff changeset
7 **
a55e39064a71 First commit of code that compiles.
Daniel O'Connor <darius@dons.net.au>
parents:
diff changeset
8 ** Copyright (c) 2021 Genesis Software, all rights reserved.
a55e39064a71 First commit of code that compiles.
Daniel O'Connor <darius@dons.net.au>
parents:
diff changeset
9 **
a55e39064a71 First commit of code that compiles.
Daniel O'Connor <darius@dons.net.au>
parents:
diff changeset
10 *******************************************************************
a55e39064a71 First commit of code that compiles.
Daniel O'Connor <darius@dons.net.au>
parents:
diff changeset
11 ******************************************************************/
a55e39064a71 First commit of code that compiles.
Daniel O'Connor <darius@dons.net.au>
parents:
diff changeset
12
a55e39064a71 First commit of code that compiles.
Daniel O'Connor <darius@dons.net.au>
parents:
diff changeset
13 /*
a55e39064a71 First commit of code that compiles.
Daniel O'Connor <darius@dons.net.au>
parents:
diff changeset
14 ** MODULATOR.C
a55e39064a71 First commit of code that compiles.
Daniel O'Connor <darius@dons.net.au>
parents:
diff changeset
15 **
a55e39064a71 First commit of code that compiles.
Daniel O'Connor <darius@dons.net.au>
parents:
diff changeset
16 ** Create modulation shape
a55e39064a71 First commit of code that compiles.
Daniel O'Connor <darius@dons.net.au>
parents:
diff changeset
17 **
a55e39064a71 First commit of code that compiles.
Daniel O'Connor <darius@dons.net.au>
parents:
diff changeset
18 */
a55e39064a71 First commit of code that compiles.
Daniel O'Connor <darius@dons.net.au>
parents:
diff changeset
19
5
Daniel O'Connor <darius@dons.net.au>
parents: 3
diff changeset
20 #include <stdio.h>
Daniel O'Connor <darius@dons.net.au>
parents: 3
diff changeset
21 #include <string.h>
Daniel O'Connor <darius@dons.net.au>
parents: 3
diff changeset
22 #include "bitstring.h"
Daniel O'Connor <darius@dons.net.au>
parents: 3
diff changeset
23
Daniel O'Connor <darius@dons.net.au>
parents: 3
diff changeset
24 #pragma GCC diagnostic push
Daniel O'Connor <darius@dons.net.au>
parents: 3
diff changeset
25 #pragma GCC diagnostic ignored "-Wtype-limits"
Daniel O'Connor <darius@dons.net.au>
parents: 3
diff changeset
26 #pragma GCC diagnostic ignored "-Wsign-compare"
0
a55e39064a71 First commit of code that compiles.
Daniel O'Connor <darius@dons.net.au>
parents:
diff changeset
27 #include "pico/stdlib.h"
a55e39064a71 First commit of code that compiles.
Daniel O'Connor <darius@dons.net.au>
parents:
diff changeset
28 #include "hardware/clocks.h"
3
b10097c3383d DMA test data repeatedly into PIO FIFO
Daniel O'Connor <darius@dons.net.au>
parents: 2
diff changeset
29 #include "hardware/dma.h"
5
Daniel O'Connor <darius@dons.net.au>
parents: 3
diff changeset
30 #include "hardware/interp.h"
3
b10097c3383d DMA test data repeatedly into PIO FIFO
Daniel O'Connor <darius@dons.net.au>
parents: 2
diff changeset
31 #include "hardware/irq.h"
5
Daniel O'Connor <darius@dons.net.au>
parents: 3
diff changeset
32 #include "hardware/pll.h"
0
a55e39064a71 First commit of code that compiles.
Daniel O'Connor <darius@dons.net.au>
parents:
diff changeset
33 #include "hardware/pio.h"
5
Daniel O'Connor <darius@dons.net.au>
parents: 3
diff changeset
34 #include "hardware/pwm.h"
Daniel O'Connor <darius@dons.net.au>
parents: 3
diff changeset
35 #include "hardware/structs/pll.h"
Daniel O'Connor <darius@dons.net.au>
parents: 3
diff changeset
36 #include "hardware/structs/clocks.h"
Daniel O'Connor <darius@dons.net.au>
parents: 3
diff changeset
37 #pragma GCC diagnostic pop
0
a55e39064a71 First commit of code that compiles.
Daniel O'Connor <darius@dons.net.au>
parents:
diff changeset
38
a55e39064a71 First commit of code that compiles.
Daniel O'Connor <darius@dons.net.au>
parents:
diff changeset
39 #include "dac.pio.h"
9
3acdebd7eec7 Make it actually work
Daniel O'Connor <darius@dons.net.au>
parents: 8
diff changeset
40 #include "trigger.pio.h"
0
a55e39064a71 First commit of code that compiles.
Daniel O'Connor <darius@dons.net.au>
parents:
diff changeset
41
5
Daniel O'Connor <darius@dons.net.au>
parents: 3
diff changeset
42 // https://github.com/howerj/q
7
4ad473648949 Copy pulse up in reverse for pulse down.
Daniel O'Connor <darius@dons.net.au>
parents: 6
diff changeset
43 // Modified to be Q20.12 rather than Q16.16
5
Daniel O'Connor <darius@dons.net.au>
parents: 3
diff changeset
44 #include "q/q.h"
0
a55e39064a71 First commit of code that compiles.
Daniel O'Connor <darius@dons.net.au>
parents:
diff changeset
45
5
Daniel O'Connor <darius@dons.net.au>
parents: 3
diff changeset
46 #include "shaped-trap.h"
3
b10097c3383d DMA test data repeatedly into PIO FIFO
Daniel O'Connor <darius@dons.net.au>
parents: 2
diff changeset
47
9
3acdebd7eec7 Make it actually work
Daniel O'Connor <darius@dons.net.au>
parents: 8
diff changeset
48 // Pulse control bits
3acdebd7eec7 Make it actually work
Daniel O'Connor <darius@dons.net.au>
parents: 8
diff changeset
49 #define SENSE 0x01
3acdebd7eec7 Make it actually work
Daniel O'Connor <darius@dons.net.au>
parents: 8
diff changeset
50 #define GATE 0x02
3acdebd7eec7 Make it actually work
Daniel O'Connor <darius@dons.net.au>
parents: 8
diff changeset
51 #define PHINV 0x04
3acdebd7eec7 Make it actually work
Daniel O'Connor <darius@dons.net.au>
parents: 8
diff changeset
52 #define PACTIVE 0x08
3acdebd7eec7 Make it actually work
Daniel O'Connor <darius@dons.net.au>
parents: 8
diff changeset
53
3
b10097c3383d DMA test data repeatedly into PIO FIFO
Daniel O'Connor <darius@dons.net.au>
parents: 2
diff changeset
54 static int dma_chan;
5
Daniel O'Connor <darius@dons.net.au>
parents: 3
diff changeset
55 uint8_t pulse_data[65536];
Daniel O'Connor <darius@dons.net.au>
parents: 3
diff changeset
56 uint8_t pulse_ctrl[65536];
9
3acdebd7eec7 Make it actually work
Daniel O'Connor <darius@dons.net.au>
parents: 8
diff changeset
57 unsigned slice_num = 0;
3acdebd7eec7 Make it actually work
Daniel O'Connor <darius@dons.net.au>
parents: 8
diff changeset
58 PIO pulse_pio;
3acdebd7eec7 Make it actually work
Daniel O'Connor <darius@dons.net.au>
parents: 8
diff changeset
59 uint pulse_sm;
3
b10097c3383d DMA test data repeatedly into PIO FIFO
Daniel O'Connor <darius@dons.net.au>
parents: 2
diff changeset
60
9
3acdebd7eec7 Make it actually work
Daniel O'Connor <darius@dons.net.au>
parents: 8
diff changeset
61 /*
3acdebd7eec7 Make it actually work
Daniel O'Connor <darius@dons.net.au>
parents: 8
diff changeset
62 * Use a DMA channel to feed PIO0 SM0 with pulse data.
3acdebd7eec7 Make it actually work
Daniel O'Connor <darius@dons.net.au>
parents: 8
diff changeset
63 * Each DMA transfer is a single pulse.
3acdebd7eec7 Make it actually work
Daniel O'Connor <darius@dons.net.au>
parents: 8
diff changeset
64 *
3acdebd7eec7 Make it actually work
Daniel O'Connor <darius@dons.net.au>
parents: 8
diff changeset
65 * The PIO state machine waits to be triggered before starting
3acdebd7eec7 Make it actually work
Daniel O'Connor <darius@dons.net.au>
parents: 8
diff changeset
66 * so we can use another state machine to look for the trigger edge.
3acdebd7eec7 Make it actually work
Daniel O'Connor <darius@dons.net.au>
parents: 8
diff changeset
67 *
3acdebd7eec7 Make it actually work
Daniel O'Connor <darius@dons.net.au>
parents: 8
diff changeset
68 * When the DMA is done the IRQ handler will configure it for the next
3acdebd7eec7 Make it actually work
Daniel O'Connor <darius@dons.net.au>
parents: 8
diff changeset
69 * pulse (or not if it should stop). ie reset the PIO state machine
3acdebd7eec7 Make it actually work
Daniel O'Connor <darius@dons.net.au>
parents: 8
diff changeset
70 * back to waiting for an edge and re-arm the DMA.
3acdebd7eec7 Make it actually work
Daniel O'Connor <darius@dons.net.au>
parents: 8
diff changeset
71 */
3
b10097c3383d DMA test data repeatedly into PIO FIFO
Daniel O'Connor <darius@dons.net.au>
parents: 2
diff changeset
72 void
b10097c3383d DMA test data repeatedly into PIO FIFO
Daniel O'Connor <darius@dons.net.au>
parents: 2
diff changeset
73 dma_handler(void) {
b10097c3383d DMA test data repeatedly into PIO FIFO
Daniel O'Connor <darius@dons.net.au>
parents: 2
diff changeset
74 // Clear the interrupt request.
b10097c3383d DMA test data repeatedly into PIO FIFO
Daniel O'Connor <darius@dons.net.au>
parents: 2
diff changeset
75 dma_hw->ints0 = 1u << dma_chan;
b10097c3383d DMA test data repeatedly into PIO FIFO
Daniel O'Connor <darius@dons.net.au>
parents: 2
diff changeset
76 // Give the channel a new wave table entry to read from, and re-trigger it
5
Daniel O'Connor <darius@dons.net.au>
parents: 3
diff changeset
77 //dma_channel_set_read_addr(dma_chan, shaped_trap_dat_start, true);
9
3acdebd7eec7 Make it actually work
Daniel O'Connor <darius@dons.net.au>
parents: 8
diff changeset
78 // Reset pulse state machine back to waiting for trigger
3acdebd7eec7 Make it actually work
Daniel O'Connor <darius@dons.net.au>
parents: 8
diff changeset
79 //pio_sm_exec(pulse_pio, pulse_sm, pio_encode_jump(0);
5
Daniel O'Connor <darius@dons.net.au>
parents: 3
diff changeset
80 }
Daniel O'Connor <darius@dons.net.au>
parents: 3
diff changeset
81
Daniel O'Connor <darius@dons.net.au>
parents: 3
diff changeset
82
Daniel O'Connor <darius@dons.net.au>
parents: 3
diff changeset
83 void
Daniel O'Connor <darius@dons.net.au>
parents: 3
diff changeset
84 pwm_wrap(void) {
Daniel O'Connor <darius@dons.net.au>
parents: 3
diff changeset
85 pwm_clear_irq(slice_num);
Daniel O'Connor <darius@dons.net.au>
parents: 3
diff changeset
86 #if 0
Daniel O'Connor <darius@dons.net.au>
parents: 3
diff changeset
87 static unsigned state = 0;
Daniel O'Connor <darius@dons.net.au>
parents: 3
diff changeset
88
Daniel O'Connor <darius@dons.net.au>
parents: 3
diff changeset
89 gpio_put(PICO_DEFAULT_LED_PIN, state);
Daniel O'Connor <darius@dons.net.au>
parents: 3
diff changeset
90 state = !state;
Daniel O'Connor <darius@dons.net.au>
parents: 3
diff changeset
91 #endif
Daniel O'Connor <darius@dons.net.au>
parents: 3
diff changeset
92
Daniel O'Connor <darius@dons.net.au>
parents: 3
diff changeset
93 // Trigger another pulse read out
Daniel O'Connor <darius@dons.net.au>
parents: 3
diff changeset
94 dma_channel_set_read_addr(dma_chan, pulse_data, true);
9
3acdebd7eec7 Make it actually work
Daniel O'Connor <darius@dons.net.au>
parents: 8
diff changeset
95 gpio_put(2, 1);
3acdebd7eec7 Make it actually work
Daniel O'Connor <darius@dons.net.au>
parents: 8
diff changeset
96 gpio_put(2, 0);
5
Daniel O'Connor <darius@dons.net.au>
parents: 3
diff changeset
97 }
Daniel O'Connor <darius@dons.net.au>
parents: 3
diff changeset
98
Daniel O'Connor <darius@dons.net.au>
parents: 3
diff changeset
99 // Calculate pulse shape data
8
0249d0cecac4 Use interpolator to compute pulse up.
Daniel O'Connor <darius@dons.net.au>
parents: 7
diff changeset
100 // TODO: predistortion, proper sense, gate, phase, active, T/R switch
5
Daniel O'Connor <darius@dons.net.au>
parents: 3
diff changeset
101 // Could encode them as bit stream like data but more compact would be
Daniel O'Connor <darius@dons.net.au>
parents: 3
diff changeset
102 // (say) a list of counts to toggle pins at
Daniel O'Connor <darius@dons.net.au>
parents: 3
diff changeset
103 // Need to add pre/postgate/sense/phase counters
Daniel O'Connor <darius@dons.net.au>
parents: 3
diff changeset
104 unsigned
Daniel O'Connor <darius@dons.net.au>
parents: 3
diff changeset
105 compute_pulse(uint8_t *data, uint8_t *ctrl, unsigned datalen, uint16_t plen, char *code, uint8_t ncode, const uint8_t *shape, uint8_t shapelen, uint8_t codegap, uint8_t slew1, uint8_t slew2, uint8_t dcofs) {
7
4ad473648949 Copy pulse up in reverse for pulse down.
Daniel O'Connor <darius@dons.net.au>
parents: 6
diff changeset
106 uint32_t shapesamples, nsamples, idx, bit1startup, bit1stopup;
5
Daniel O'Connor <darius@dons.net.au>
parents: 3
diff changeset
107 q_t dcscale, stepsize;
Daniel O'Connor <darius@dons.net.au>
parents: 3
diff changeset
108 char tmps[20];
7
4ad473648949 Copy pulse up in reverse for pulse down.
Daniel O'Connor <darius@dons.net.au>
parents: 6
diff changeset
109 interp_config cfg;
4ad473648949 Copy pulse up in reverse for pulse down.
Daniel O'Connor <darius@dons.net.au>
parents: 6
diff changeset
110
8
0249d0cecac4 Use interpolator to compute pulse up.
Daniel O'Connor <darius@dons.net.au>
parents: 7
diff changeset
111 if (ncode == 1) {
0249d0cecac4 Use interpolator to compute pulse up.
Daniel O'Connor <darius@dons.net.au>
parents: 7
diff changeset
112 // Number of samples for half of the pulse
0249d0cecac4 Use interpolator to compute pulse up.
Daniel O'Connor <darius@dons.net.au>
parents: 7
diff changeset
113 // Do division first so we don't overflow Q16.16
0249d0cecac4 Use interpolator to compute pulse up.
Daniel O'Connor <darius@dons.net.au>
parents: 7
diff changeset
114 shapesamples = qtoi(qmul(qdiv(qint(plen), qint(100)), qint(shapelen / 2)));
0249d0cecac4 Use interpolator to compute pulse up.
Daniel O'Connor <darius@dons.net.au>
parents: 7
diff changeset
115 // Number of samples for everything
0249d0cecac4 Use interpolator to compute pulse up.
Daniel O'Connor <darius@dons.net.au>
parents: 7
diff changeset
116 // XXX: Need the +1 otherwise slew2 is truncated
0249d0cecac4 Use interpolator to compute pulse up.
Daniel O'Connor <darius@dons.net.au>
parents: 7
diff changeset
117 nsamples = shapesamples * 2 + slew1 + slew2 + 1;
0249d0cecac4 Use interpolator to compute pulse up.
Daniel O'Connor <darius@dons.net.au>
parents: 7
diff changeset
118 } else {
0249d0cecac4 Use interpolator to compute pulse up.
Daniel O'Connor <darius@dons.net.au>
parents: 7
diff changeset
119 shapesamples = plen / 2;
0249d0cecac4 Use interpolator to compute pulse up.
Daniel O'Connor <darius@dons.net.au>
parents: 7
diff changeset
120 nsamples = shapesamples * 2 * ncode + codegap * (ncode - 1) + slew1 + slew2 + 1;
0249d0cecac4 Use interpolator to compute pulse up.
Daniel O'Connor <darius@dons.net.au>
parents: 7
diff changeset
121 }
0249d0cecac4 Use interpolator to compute pulse up.
Daniel O'Connor <darius@dons.net.au>
parents: 7
diff changeset
122
0249d0cecac4 Use interpolator to compute pulse up.
Daniel O'Connor <darius@dons.net.au>
parents: 7
diff changeset
123 // Number of steps per samples in the pulse shape
0249d0cecac4 Use interpolator to compute pulse up.
Daniel O'Connor <darius@dons.net.au>
parents: 7
diff changeset
124 stepsize = qdiv(qint(shapelen), qint(shapesamples));
0249d0cecac4 Use interpolator to compute pulse up.
Daniel O'Connor <darius@dons.net.au>
parents: 7
diff changeset
125 qsprint(stepsize, tmps, sizeof(tmps));
0249d0cecac4 Use interpolator to compute pulse up.
Daniel O'Connor <darius@dons.net.au>
parents: 7
diff changeset
126 printf("shapelen = %d shapesamples = %lu nsamples = %lu stepsize = %s\n", shapelen, shapesamples, nsamples, tmps);
0249d0cecac4 Use interpolator to compute pulse up.
Daniel O'Connor <darius@dons.net.au>
parents: 7
diff changeset
127
0249d0cecac4 Use interpolator to compute pulse up.
Daniel O'Connor <darius@dons.net.au>
parents: 7
diff changeset
128 // Check the requested pulse will not overflow given data
0249d0cecac4 Use interpolator to compute pulse up.
Daniel O'Connor <darius@dons.net.au>
parents: 7
diff changeset
129 if (nsamples > datalen) {
0249d0cecac4 Use interpolator to compute pulse up.
Daniel O'Connor <darius@dons.net.au>
parents: 7
diff changeset
130 printf("Pulse too long (%ld > %u)\n", nsamples, datalen);
0249d0cecac4 Use interpolator to compute pulse up.
Daniel O'Connor <darius@dons.net.au>
parents: 7
diff changeset
131 return 0;
0249d0cecac4 Use interpolator to compute pulse up.
Daniel O'Connor <darius@dons.net.au>
parents: 7
diff changeset
132 }
0249d0cecac4 Use interpolator to compute pulse up.
Daniel O'Connor <darius@dons.net.au>
parents: 7
diff changeset
133 // Check it is not too short
0249d0cecac4 Use interpolator to compute pulse up.
Daniel O'Connor <darius@dons.net.au>
parents: 7
diff changeset
134 if (shapesamples < 2) {
0249d0cecac4 Use interpolator to compute pulse up.
Daniel O'Connor <darius@dons.net.au>
parents: 7
diff changeset
135 printf("Pulse too short (%lu < %d)\n", shapesamples, 2);
0249d0cecac4 Use interpolator to compute pulse up.
Daniel O'Connor <darius@dons.net.au>
parents: 7
diff changeset
136 return 0;
0249d0cecac4 Use interpolator to compute pulse up.
Daniel O'Connor <darius@dons.net.au>
parents: 7
diff changeset
137 }
0249d0cecac4 Use interpolator to compute pulse up.
Daniel O'Connor <darius@dons.net.au>
parents: 7
diff changeset
138 // Or too long (will overflow for loop variable)
0249d0cecac4 Use interpolator to compute pulse up.
Daniel O'Connor <darius@dons.net.au>
parents: 7
diff changeset
139 if (qtoi(shapesamples) > 65535) {
0249d0cecac4 Use interpolator to compute pulse up.
Daniel O'Connor <darius@dons.net.au>
parents: 7
diff changeset
140 printf("Shape too long (%u > %d)\n", qtoi(shapesamples), 65535);
0249d0cecac4 Use interpolator to compute pulse up.
Daniel O'Connor <darius@dons.net.au>
parents: 7
diff changeset
141 return 0;
0249d0cecac4 Use interpolator to compute pulse up.
Daniel O'Connor <darius@dons.net.au>
parents: 7
diff changeset
142 }
0249d0cecac4 Use interpolator to compute pulse up.
Daniel O'Connor <darius@dons.net.au>
parents: 7
diff changeset
143
0249d0cecac4 Use interpolator to compute pulse up.
Daniel O'Connor <darius@dons.net.au>
parents: 7
diff changeset
144 // Setup interp 0 lane 0 to generate index into shape table
7
4ad473648949 Copy pulse up in reverse for pulse down.
Daniel O'Connor <darius@dons.net.au>
parents: 6
diff changeset
145 // Mask start is 0 because we use 8 bit samples
4ad473648949 Copy pulse up in reverse for pulse down.
Daniel O'Connor <darius@dons.net.au>
parents: 6
diff changeset
146 cfg = interp_default_config();
4ad473648949 Copy pulse up in reverse for pulse down.
Daniel O'Connor <darius@dons.net.au>
parents: 6
diff changeset
147 interp_config_set_shift(&cfg, QBITS);
4ad473648949 Copy pulse up in reverse for pulse down.
Daniel O'Connor <darius@dons.net.au>
parents: 6
diff changeset
148 interp_config_set_mask(&cfg, 0, 32 - QBITS);
4ad473648949 Copy pulse up in reverse for pulse down.
Daniel O'Connor <darius@dons.net.au>
parents: 6
diff changeset
149 interp_config_set_blend(&cfg, true);
4ad473648949 Copy pulse up in reverse for pulse down.
Daniel O'Connor <darius@dons.net.au>
parents: 6
diff changeset
150 interp_set_config(interp0, 0, &cfg);
4ad473648949 Copy pulse up in reverse for pulse down.
Daniel O'Connor <darius@dons.net.au>
parents: 6
diff changeset
151
8
0249d0cecac4 Use interpolator to compute pulse up.
Daniel O'Connor <darius@dons.net.au>
parents: 7
diff changeset
152 // Setup interp 0 lane 1 to LERP each sample pair
7
4ad473648949 Copy pulse up in reverse for pulse down.
Daniel O'Connor <darius@dons.net.au>
parents: 6
diff changeset
153 cfg = interp_default_config();
4ad473648949 Copy pulse up in reverse for pulse down.
Daniel O'Connor <darius@dons.net.au>
parents: 6
diff changeset
154 interp_config_set_shift(&cfg, QBITS - 8);
4ad473648949 Copy pulse up in reverse for pulse down.
Daniel O'Connor <darius@dons.net.au>
parents: 6
diff changeset
155 interp_config_set_signed(&cfg, false);
4ad473648949 Copy pulse up in reverse for pulse down.
Daniel O'Connor <darius@dons.net.au>
parents: 6
diff changeset
156 interp_config_set_cross_input(&cfg, true); // unsigned blending
4ad473648949 Copy pulse up in reverse for pulse down.
Daniel O'Connor <darius@dons.net.au>
parents: 6
diff changeset
157 interp_set_config(interp0, 1, &cfg);
4ad473648949 Copy pulse up in reverse for pulse down.
Daniel O'Connor <darius@dons.net.au>
parents: 6
diff changeset
158
8
0249d0cecac4 Use interpolator to compute pulse up.
Daniel O'Connor <darius@dons.net.au>
parents: 7
diff changeset
159 // Setup interp 1 lane 0 to clamp 0-255
0249d0cecac4 Use interpolator to compute pulse up.
Daniel O'Connor <darius@dons.net.au>
parents: 7
diff changeset
160 cfg = interp_default_config();
0249d0cecac4 Use interpolator to compute pulse up.
Daniel O'Connor <darius@dons.net.au>
parents: 7
diff changeset
161 interp_config_set_clamp(&cfg, true);
0249d0cecac4 Use interpolator to compute pulse up.
Daniel O'Connor <darius@dons.net.au>
parents: 7
diff changeset
162 interp_config_set_shift(&cfg, 0);
0249d0cecac4 Use interpolator to compute pulse up.
Daniel O'Connor <darius@dons.net.au>
parents: 7
diff changeset
163 interp_config_set_mask(&cfg, 0, 8);
0249d0cecac4 Use interpolator to compute pulse up.
Daniel O'Connor <darius@dons.net.au>
parents: 7
diff changeset
164 interp_config_set_signed(&cfg, false);
0249d0cecac4 Use interpolator to compute pulse up.
Daniel O'Connor <darius@dons.net.au>
parents: 7
diff changeset
165 interp_set_config(interp1, 0, &cfg);
0249d0cecac4 Use interpolator to compute pulse up.
Daniel O'Connor <darius@dons.net.au>
parents: 7
diff changeset
166 interp1->base[0] = 0;
0249d0cecac4 Use interpolator to compute pulse up.
Daniel O'Connor <darius@dons.net.au>
parents: 7
diff changeset
167 interp1->base[1] = 255;
0249d0cecac4 Use interpolator to compute pulse up.
Daniel O'Connor <darius@dons.net.au>
parents: 7
diff changeset
168
7
4ad473648949 Copy pulse up in reverse for pulse down.
Daniel O'Connor <darius@dons.net.au>
parents: 6
diff changeset
169 interp0->accum[0] = 0; // Initial offset into shape table
4ad473648949 Copy pulse up in reverse for pulse down.
Daniel O'Connor <darius@dons.net.au>
parents: 6
diff changeset
170 interp0->base[2] = (uintptr_t)shape; // Start of shape table
5
Daniel O'Connor <darius@dons.net.au>
parents: 3
diff changeset
171
8
0249d0cecac4 Use interpolator to compute pulse up.
Daniel O'Connor <darius@dons.net.au>
parents: 7
diff changeset
172 dcscale = qdiv(qsub(qint(256), qint(dcofs)), qint(255));
5
Daniel O'Connor <darius@dons.net.au>
parents: 3
diff changeset
173 qsprint(dcscale, tmps, sizeof(tmps));
Daniel O'Connor <darius@dons.net.au>
parents: 3
diff changeset
174 printf("dcscale = %s\n", tmps);
Daniel O'Connor <darius@dons.net.au>
parents: 3
diff changeset
175
8
0249d0cecac4 Use interpolator to compute pulse up.
Daniel O'Connor <darius@dons.net.au>
parents: 7
diff changeset
176 memset(pulse_data, 0, sizeof(pulse_data));
0249d0cecac4 Use interpolator to compute pulse up.
Daniel O'Connor <darius@dons.net.au>
parents: 7
diff changeset
177 memset(pulse_ctrl, 0, sizeof(pulse_ctrl));
5
Daniel O'Connor <darius@dons.net.au>
parents: 3
diff changeset
178 idx = 0;
Daniel O'Connor <darius@dons.net.au>
parents: 3
diff changeset
179
Daniel O'Connor <darius@dons.net.au>
parents: 3
diff changeset
180 // Up slew
Daniel O'Connor <darius@dons.net.au>
parents: 3
diff changeset
181 for (uint16_t i = 0; i < slew1; i++) {
Daniel O'Connor <darius@dons.net.au>
parents: 3
diff changeset
182 data[idx++] = qtoi(qdiv(qmul(qint(dcofs), qint(i)), qint(slew1)));
Daniel O'Connor <darius@dons.net.au>
parents: 3
diff changeset
183 ctrl[idx] |= PACTIVE;
Daniel O'Connor <darius@dons.net.au>
parents: 3
diff changeset
184 }
Daniel O'Connor <darius@dons.net.au>
parents: 3
diff changeset
185 for (uint16_t c = 0; c < ncode; c++) {
7
4ad473648949 Copy pulse up in reverse for pulse down.
Daniel O'Connor <darius@dons.net.au>
parents: 6
diff changeset
186 if (c == 0)
4ad473648949 Copy pulse up in reverse for pulse down.
Daniel O'Connor <darius@dons.net.au>
parents: 6
diff changeset
187 bit1startup = idx;
4ad473648949 Copy pulse up in reverse for pulse down.
Daniel O'Connor <darius@dons.net.au>
parents: 6
diff changeset
188
5
Daniel O'Connor <darius@dons.net.au>
parents: 3
diff changeset
189 uint ctrltmp = PACTIVE;
Daniel O'Connor <darius@dons.net.au>
parents: 3
diff changeset
190 if (code[c] == '0')
Daniel O'Connor <darius@dons.net.au>
parents: 3
diff changeset
191 ctrltmp |= PHINV;
Daniel O'Connor <darius@dons.net.au>
parents: 3
diff changeset
192
Daniel O'Connor <darius@dons.net.au>
parents: 3
diff changeset
193 // Pulse up
8
0249d0cecac4 Use interpolator to compute pulse up.
Daniel O'Connor <darius@dons.net.au>
parents: 7
diff changeset
194 if (c == 0) {
0249d0cecac4 Use interpolator to compute pulse up.
Daniel O'Connor <darius@dons.net.au>
parents: 7
diff changeset
195 interp0->accum[0] = 0; // Initial offset into shape table
0249d0cecac4 Use interpolator to compute pulse up.
Daniel O'Connor <darius@dons.net.au>
parents: 7
diff changeset
196 interp0->base[2] = (uintptr_t)shape; // Start of shape table
0249d0cecac4 Use interpolator to compute pulse up.
Daniel O'Connor <darius@dons.net.au>
parents: 7
diff changeset
197 }
5
Daniel O'Connor <darius@dons.net.au>
parents: 3
diff changeset
198 for (uint16_t i = 0; i < shapesamples; i++) {
8
0249d0cecac4 Use interpolator to compute pulse up.
Daniel O'Connor <darius@dons.net.au>
parents: 7
diff changeset
199 if (c == 0) {
0249d0cecac4 Use interpolator to compute pulse up.
Daniel O'Connor <darius@dons.net.au>
parents: 7
diff changeset
200 // Get sample pair
0249d0cecac4 Use interpolator to compute pulse up.
Daniel O'Connor <darius@dons.net.au>
parents: 7
diff changeset
201 uint8_t *sample_pair = (uint8_t *) interp0->peek[2];
0249d0cecac4 Use interpolator to compute pulse up.
Daniel O'Connor <darius@dons.net.au>
parents: 7
diff changeset
202 // Ask lane 1 for a LERP, using the lane 0 accumulator
0249d0cecac4 Use interpolator to compute pulse up.
Daniel O'Connor <darius@dons.net.au>
parents: 7
diff changeset
203 interp0->base[0] = sample_pair[0];
0249d0cecac4 Use interpolator to compute pulse up.
Daniel O'Connor <darius@dons.net.au>
parents: 7
diff changeset
204 interp0->base[1] = sample_pair[1];
0249d0cecac4 Use interpolator to compute pulse up.
Daniel O'Connor <darius@dons.net.au>
parents: 7
diff changeset
205 uint8_t peek = interp0->peek[1];
0249d0cecac4 Use interpolator to compute pulse up.
Daniel O'Connor <darius@dons.net.au>
parents: 7
diff changeset
206 // Apply DC offset scaling & clamp
0249d0cecac4 Use interpolator to compute pulse up.
Daniel O'Connor <darius@dons.net.au>
parents: 7
diff changeset
207 interp1->accum[0] = dcofs + qtoi(qmul(qint(peek), dcscale));
0249d0cecac4 Use interpolator to compute pulse up.
Daniel O'Connor <darius@dons.net.au>
parents: 7
diff changeset
208 data[idx++] = interp1->peek[0];
0249d0cecac4 Use interpolator to compute pulse up.
Daniel O'Connor <darius@dons.net.au>
parents: 7
diff changeset
209 // Update interpolator for next point
0249d0cecac4 Use interpolator to compute pulse up.
Daniel O'Connor <darius@dons.net.au>
parents: 7
diff changeset
210 interp0->add_raw[0] = stepsize;
0249d0cecac4 Use interpolator to compute pulse up.
Daniel O'Connor <darius@dons.net.au>
parents: 7
diff changeset
211 } else
7
4ad473648949 Copy pulse up in reverse for pulse down.
Daniel O'Connor <darius@dons.net.au>
parents: 6
diff changeset
212 // Already done it before, just copy the previous instance
4ad473648949 Copy pulse up in reverse for pulse down.
Daniel O'Connor <darius@dons.net.au>
parents: 6
diff changeset
213 data[idx++] = data[bit1startup + i];
5
Daniel O'Connor <darius@dons.net.au>
parents: 3
diff changeset
214 ctrl[idx] = ctrltmp;
Daniel O'Connor <darius@dons.net.au>
parents: 3
diff changeset
215 }
7
4ad473648949 Copy pulse up in reverse for pulse down.
Daniel O'Connor <darius@dons.net.au>
parents: 6
diff changeset
216 if (c == 0)
4ad473648949 Copy pulse up in reverse for pulse down.
Daniel O'Connor <darius@dons.net.au>
parents: 6
diff changeset
217 bit1stopup = idx - 1;
5
Daniel O'Connor <darius@dons.net.au>
parents: 3
diff changeset
218 // Pulse down
7
4ad473648949 Copy pulse up in reverse for pulse down.
Daniel O'Connor <darius@dons.net.au>
parents: 6
diff changeset
219 // Since the pulse is symmetrical just copy the up slope in reverse
8
0249d0cecac4 Use interpolator to compute pulse up.
Daniel O'Connor <darius@dons.net.au>
parents: 7
diff changeset
220 // XXX: if we had asymmetrical predistortion this wouldn't be true
5
Daniel O'Connor <darius@dons.net.au>
parents: 3
diff changeset
221 for (uint16_t i = 0; i < shapesamples; i++) {
7
4ad473648949 Copy pulse up in reverse for pulse down.
Daniel O'Connor <darius@dons.net.au>
parents: 6
diff changeset
222 data[idx++] = data[bit1stopup - i];
5
Daniel O'Connor <darius@dons.net.au>
parents: 3
diff changeset
223 // Could replace this with a separate loop to poke it into place
Daniel O'Connor <darius@dons.net.au>
parents: 3
diff changeset
224 // Similarly for TR switch when implemented
Daniel O'Connor <darius@dons.net.au>
parents: 3
diff changeset
225 if (i == 0 && c == 0)
Daniel O'Connor <darius@dons.net.au>
parents: 3
diff changeset
226 ctrl[idx] = ctrltmp | SENSE;
Daniel O'Connor <darius@dons.net.au>
parents: 3
diff changeset
227 else
Daniel O'Connor <darius@dons.net.au>
parents: 3
diff changeset
228 ctrl[idx] = ctrltmp;
Daniel O'Connor <darius@dons.net.au>
parents: 3
diff changeset
229 }
Daniel O'Connor <darius@dons.net.au>
parents: 3
diff changeset
230
Daniel O'Connor <darius@dons.net.au>
parents: 3
diff changeset
231 // Code gap
Daniel O'Connor <darius@dons.net.au>
parents: 3
diff changeset
232 if (c < ncode - 1)
Daniel O'Connor <darius@dons.net.au>
parents: 3
diff changeset
233 for (uint16_t i = 0; i < codegap; i++) {
Daniel O'Connor <darius@dons.net.au>
parents: 3
diff changeset
234 data[idx++] = dcofs;
Daniel O'Connor <darius@dons.net.au>
parents: 3
diff changeset
235 ctrl[idx] = ctrltmp;
Daniel O'Connor <darius@dons.net.au>
parents: 3
diff changeset
236 }
Daniel O'Connor <darius@dons.net.au>
parents: 3
diff changeset
237 }
Daniel O'Connor <darius@dons.net.au>
parents: 3
diff changeset
238
Daniel O'Connor <darius@dons.net.au>
parents: 3
diff changeset
239 // Down slew
8
0249d0cecac4 Use interpolator to compute pulse up.
Daniel O'Connor <darius@dons.net.au>
parents: 7
diff changeset
240 for (uint16_t i = 0; i < slew2 + 1; i++) {
5
Daniel O'Connor <darius@dons.net.au>
parents: 3
diff changeset
241 data[idx++] = qtoi(qdiv(qmul(qint(dcofs), qint(slew2 - i)), qint(slew2)));
Daniel O'Connor <darius@dons.net.au>
parents: 3
diff changeset
242 ctrl[idx] |= PACTIVE;
Daniel O'Connor <darius@dons.net.au>
parents: 3
diff changeset
243 }
Daniel O'Connor <darius@dons.net.au>
parents: 3
diff changeset
244 return idx - 1;
Daniel O'Connor <darius@dons.net.au>
parents: 3
diff changeset
245 }
Daniel O'Connor <darius@dons.net.au>
parents: 3
diff changeset
246
0
a55e39064a71 First commit of code that compiles.
Daniel O'Connor <darius@dons.net.au>
parents:
diff changeset
247 int
3
b10097c3383d DMA test data repeatedly into PIO FIFO
Daniel O'Connor <darius@dons.net.au>
parents: 2
diff changeset
248 main(void) {
5
Daniel O'Connor <darius@dons.net.au>
parents: 3
diff changeset
249 absolute_time_t then, now;
Daniel O'Connor <darius@dons.net.au>
parents: 3
diff changeset
250
Daniel O'Connor <darius@dons.net.au>
parents: 3
diff changeset
251 // Set sysclk to 120MHz
Daniel O'Connor <darius@dons.net.au>
parents: 3
diff changeset
252 set_sys_clock_khz(120000, true);
0
a55e39064a71 First commit of code that compiles.
Daniel O'Connor <darius@dons.net.au>
parents:
diff changeset
253
a55e39064a71 First commit of code that compiles.
Daniel O'Connor <darius@dons.net.au>
parents:
diff changeset
254 stdio_init_all();
5
Daniel O'Connor <darius@dons.net.au>
parents: 3
diff changeset
255 printf("\n\n\nIniting\n");
0
a55e39064a71 First commit of code that compiles.
Daniel O'Connor <darius@dons.net.au>
parents:
diff changeset
256
5
Daniel O'Connor <darius@dons.net.au>
parents: 3
diff changeset
257 // Needed otherwise timer related functions hang under debugging
Daniel O'Connor <darius@dons.net.au>
parents: 3
diff changeset
258 // https://github.com/raspberrypi/pico-sdk/issues/1152#issuecomment-1418248639
Daniel O'Connor <darius@dons.net.au>
parents: 3
diff changeset
259 timer_hw->dbgpause = 0;
Daniel O'Connor <darius@dons.net.au>
parents: 3
diff changeset
260
Daniel O'Connor <darius@dons.net.au>
parents: 3
diff changeset
261 gpio_init(PICO_DEFAULT_LED_PIN);
Daniel O'Connor <darius@dons.net.au>
parents: 3
diff changeset
262 gpio_set_dir(PICO_DEFAULT_LED_PIN, GPIO_OUT);
9
3acdebd7eec7 Make it actually work
Daniel O'Connor <darius@dons.net.au>
parents: 8
diff changeset
263 gpio_init(2);
3acdebd7eec7 Make it actually work
Daniel O'Connor <darius@dons.net.au>
parents: 8
diff changeset
264 gpio_set_dir(2, GPIO_OUT);
3acdebd7eec7 Make it actually work
Daniel O'Connor <darius@dons.net.au>
parents: 8
diff changeset
265 #if 0
3acdebd7eec7 Make it actually work
Daniel O'Connor <darius@dons.net.au>
parents: 8
diff changeset
266 for (unsigned i = 7; i < 7 + 9; i++) {
3acdebd7eec7 Make it actually work
Daniel O'Connor <darius@dons.net.au>
parents: 8
diff changeset
267 printf("GPIO %d\n", i);
3acdebd7eec7 Make it actually work
Daniel O'Connor <darius@dons.net.au>
parents: 8
diff changeset
268 gpio_init(i);
3acdebd7eec7 Make it actually work
Daniel O'Connor <darius@dons.net.au>
parents: 8
diff changeset
269 gpio_set_dir(i, GPIO_OUT);
3acdebd7eec7 Make it actually work
Daniel O'Connor <darius@dons.net.au>
parents: 8
diff changeset
270 printf("on\n");
3acdebd7eec7 Make it actually work
Daniel O'Connor <darius@dons.net.au>
parents: 8
diff changeset
271 gpio_put(i, 1);
3acdebd7eec7 Make it actually work
Daniel O'Connor <darius@dons.net.au>
parents: 8
diff changeset
272 __breakpoint();
3acdebd7eec7 Make it actually work
Daniel O'Connor <darius@dons.net.au>
parents: 8
diff changeset
273 printf("off\n");
3acdebd7eec7 Make it actually work
Daniel O'Connor <darius@dons.net.au>
parents: 8
diff changeset
274 gpio_put(i, 0);
3acdebd7eec7 Make it actually work
Daniel O'Connor <darius@dons.net.au>
parents: 8
diff changeset
275 __breakpoint();
3acdebd7eec7 Make it actually work
Daniel O'Connor <darius@dons.net.au>
parents: 8
diff changeset
276 }
3acdebd7eec7 Make it actually work
Daniel O'Connor <darius@dons.net.au>
parents: 8
diff changeset
277 #endif
5
Daniel O'Connor <darius@dons.net.au>
parents: 3
diff changeset
278
Daniel O'Connor <darius@dons.net.au>
parents: 3
diff changeset
279 uint32_t idx;
8
0249d0cecac4 Use interpolator to compute pulse up.
Daniel O'Connor <darius@dons.net.au>
parents: 7
diff changeset
280 uint16_t plen;
0249d0cecac4 Use interpolator to compute pulse up.
Daniel O'Connor <darius@dons.net.au>
parents: 7
diff changeset
281 char *code;
9
3acdebd7eec7 Make it actually work
Daniel O'Connor <darius@dons.net.au>
parents: 8
diff changeset
282 if (1) {
8
0249d0cecac4 Use interpolator to compute pulse up.
Daniel O'Connor <darius@dons.net.au>
parents: 7
diff changeset
283 plen = 8000;
0249d0cecac4 Use interpolator to compute pulse up.
Daniel O'Connor <darius@dons.net.au>
parents: 7
diff changeset
284 code = "1110010";
0249d0cecac4 Use interpolator to compute pulse up.
Daniel O'Connor <darius@dons.net.au>
parents: 7
diff changeset
285 } else {
0249d0cecac4 Use interpolator to compute pulse up.
Daniel O'Connor <darius@dons.net.au>
parents: 7
diff changeset
286 plen = 53000;
0249d0cecac4 Use interpolator to compute pulse up.
Daniel O'Connor <darius@dons.net.au>
parents: 7
diff changeset
287 code = "1";
0249d0cecac4 Use interpolator to compute pulse up.
Daniel O'Connor <darius@dons.net.au>
parents: 7
diff changeset
288 }
0249d0cecac4 Use interpolator to compute pulse up.
Daniel O'Connor <darius@dons.net.au>
parents: 7
diff changeset
289
5
Daniel O'Connor <darius@dons.net.au>
parents: 3
diff changeset
290 uint8_t codegap = 4;
Daniel O'Connor <darius@dons.net.au>
parents: 3
diff changeset
291 uint8_t slew1 = 10;
Daniel O'Connor <darius@dons.net.au>
parents: 3
diff changeset
292 uint8_t slew2 = 10;
Daniel O'Connor <darius@dons.net.au>
parents: 3
diff changeset
293 uint8_t dcofs = 110;
Daniel O'Connor <darius@dons.net.au>
parents: 3
diff changeset
294 then = get_absolute_time();
Daniel O'Connor <darius@dons.net.au>
parents: 3
diff changeset
295 if ((idx = compute_pulse(pulse_data, pulse_ctrl, sizeof(pulse_data),
Daniel O'Connor <darius@dons.net.au>
parents: 3
diff changeset
296 plen, code, strlen(code),
Daniel O'Connor <darius@dons.net.au>
parents: 3
diff changeset
297 shaped_trap, sizeof(shaped_trap),
Daniel O'Connor <darius@dons.net.au>
parents: 3
diff changeset
298 codegap, slew1, slew2, dcofs)) == 0) {
Daniel O'Connor <darius@dons.net.au>
parents: 3
diff changeset
299 printf("Failed to compute pulse\n");
Daniel O'Connor <darius@dons.net.au>
parents: 3
diff changeset
300 while (1)
Daniel O'Connor <darius@dons.net.au>
parents: 3
diff changeset
301 ;
Daniel O'Connor <darius@dons.net.au>
parents: 3
diff changeset
302 }
Daniel O'Connor <darius@dons.net.au>
parents: 3
diff changeset
303 now = get_absolute_time();
8
0249d0cecac4 Use interpolator to compute pulse up.
Daniel O'Connor <darius@dons.net.au>
parents: 7
diff changeset
304 unsigned long long diff = absolute_time_diff_us(then, now);
0249d0cecac4 Use interpolator to compute pulse up.
Daniel O'Connor <darius@dons.net.au>
parents: 7
diff changeset
305 printf("Pulse computation took %lld usec and created %lu samples - %.1f nsec/sample\n",
0249d0cecac4 Use interpolator to compute pulse up.
Daniel O'Connor <darius@dons.net.au>
parents: 7
diff changeset
306 diff, idx, (float)diff * 1000.0 / idx);
0249d0cecac4 Use interpolator to compute pulse up.
Daniel O'Connor <darius@dons.net.au>
parents: 7
diff changeset
307 __breakpoint();
9
3acdebd7eec7 Make it actually work
Daniel O'Connor <darius@dons.net.au>
parents: 8
diff changeset
308
3acdebd7eec7 Make it actually work
Daniel O'Connor <darius@dons.net.au>
parents: 8
diff changeset
309 // Load the clocked_input program, and configure a free state machine
3acdebd7eec7 Make it actually work
Daniel O'Connor <darius@dons.net.au>
parents: 8
diff changeset
310 // to run the program.
3acdebd7eec7 Make it actually work
Daniel O'Connor <darius@dons.net.au>
parents: 8
diff changeset
311 PIO pulse_pio = pio0;
3acdebd7eec7 Make it actually work
Daniel O'Connor <darius@dons.net.au>
parents: 8
diff changeset
312 uint offset = pio_add_program(pulse_pio, &dac_program);
3acdebd7eec7 Make it actually work
Daniel O'Connor <darius@dons.net.au>
parents: 8
diff changeset
313 uint pulse_sm = pio_claim_unused_sm(pulse_pio, true);
3acdebd7eec7 Make it actually work
Daniel O'Connor <darius@dons.net.au>
parents: 8
diff changeset
314 // Data is GPIO7 to GPIO14, clock is GPIO15
3acdebd7eec7 Make it actually work
Daniel O'Connor <darius@dons.net.au>
parents: 8
diff changeset
315 // Clock divisor of 2 so it runs at 60MHz and
3acdebd7eec7 Make it actually work
Daniel O'Connor <darius@dons.net.au>
parents: 8
diff changeset
316 // generates a 30MHz clock
3acdebd7eec7 Make it actually work
Daniel O'Connor <darius@dons.net.au>
parents: 8
diff changeset
317 dac_program_init(pulse_pio, pulse_sm, offset, 7, 2);
3acdebd7eec7 Make it actually work
Daniel O'Connor <darius@dons.net.au>
parents: 8
diff changeset
318
3acdebd7eec7 Make it actually work
Daniel O'Connor <darius@dons.net.au>
parents: 8
diff changeset
319 // Configure a channel to write 32 bits at a time to PIO0
3acdebd7eec7 Make it actually work
Daniel O'Connor <darius@dons.net.au>
parents: 8
diff changeset
320 // SM0's TX FIFO, paced by the data request signal from that peripheral.
3acdebd7eec7 Make it actually work
Daniel O'Connor <darius@dons.net.au>
parents: 8
diff changeset
321 dma_chan = dma_claim_unused_channel(true);
3acdebd7eec7 Make it actually work
Daniel O'Connor <darius@dons.net.au>
parents: 8
diff changeset
322 dma_channel_config dmac = dma_channel_get_default_config(dma_chan);
3acdebd7eec7 Make it actually work
Daniel O'Connor <darius@dons.net.au>
parents: 8
diff changeset
323 channel_config_set_transfer_data_size(&dmac, DMA_SIZE_32);
3acdebd7eec7 Make it actually work
Daniel O'Connor <darius@dons.net.au>
parents: 8
diff changeset
324 channel_config_set_read_increment(&dmac, true);
3acdebd7eec7 Make it actually work
Daniel O'Connor <darius@dons.net.au>
parents: 8
diff changeset
325 channel_config_set_dreq(&dmac, DREQ_PIO0_TX0);
3acdebd7eec7 Make it actually work
Daniel O'Connor <darius@dons.net.au>
parents: 8
diff changeset
326
3acdebd7eec7 Make it actually work
Daniel O'Connor <darius@dons.net.au>
parents: 8
diff changeset
327 dma_channel_configure(
3acdebd7eec7 Make it actually work
Daniel O'Connor <darius@dons.net.au>
parents: 8
diff changeset
328 dma_chan,
3acdebd7eec7 Make it actually work
Daniel O'Connor <darius@dons.net.au>
parents: 8
diff changeset
329 &dmac,
3acdebd7eec7 Make it actually work
Daniel O'Connor <darius@dons.net.au>
parents: 8
diff changeset
330 &pio0_hw->txf[0], // Write address (only need to set this once)
3acdebd7eec7 Make it actually work
Daniel O'Connor <darius@dons.net.au>
parents: 8
diff changeset
331 NULL, // Don't provide a read address yet
3acdebd7eec7 Make it actually work
Daniel O'Connor <darius@dons.net.au>
parents: 8
diff changeset
332 (idx + 1) >> 2, // Transfer count (round up to 4 bytes)
3acdebd7eec7 Make it actually work
Daniel O'Connor <darius@dons.net.au>
parents: 8
diff changeset
333 false // Don't start yet
3acdebd7eec7 Make it actually work
Daniel O'Connor <darius@dons.net.au>
parents: 8
diff changeset
334 );
3acdebd7eec7 Make it actually work
Daniel O'Connor <darius@dons.net.au>
parents: 8
diff changeset
335
3acdebd7eec7 Make it actually work
Daniel O'Connor <darius@dons.net.au>
parents: 8
diff changeset
336 // Tell the DMA to raise IRQ line 0 when the channel finishes a block
3acdebd7eec7 Make it actually work
Daniel O'Connor <darius@dons.net.au>
parents: 8
diff changeset
337 dma_channel_set_irq0_enabled(dma_chan, true);
3acdebd7eec7 Make it actually work
Daniel O'Connor <darius@dons.net.au>
parents: 8
diff changeset
338
3acdebd7eec7 Make it actually work
Daniel O'Connor <darius@dons.net.au>
parents: 8
diff changeset
339 // Configure the processor to run dma_handler() when DMA IRQ 0 is asserted
3acdebd7eec7 Make it actually work
Daniel O'Connor <darius@dons.net.au>
parents: 8
diff changeset
340 irq_set_exclusive_handler(DMA_IRQ_0, dma_handler);
3acdebd7eec7 Make it actually work
Daniel O'Connor <darius@dons.net.au>
parents: 8
diff changeset
341 irq_set_enabled(DMA_IRQ_0, true);
3acdebd7eec7 Make it actually work
Daniel O'Connor <darius@dons.net.au>
parents: 8
diff changeset
342
5
Daniel O'Connor <darius@dons.net.au>
parents: 3
diff changeset
343 // 120MHz / 250 = 480kHz base
Daniel O'Connor <darius@dons.net.au>
parents: 3
diff changeset
344 // Maximum divisor is only 256 which limits the low end,
Daniel O'Connor <darius@dons.net.au>
parents: 3
diff changeset
345 // could further subdivide in the IRQ handler
9
3acdebd7eec7 Make it actually work
Daniel O'Connor <darius@dons.net.au>
parents: 8
diff changeset
346 pwm_config c = pwm_get_default_config();
5
Daniel O'Connor <darius@dons.net.au>
parents: 3
diff changeset
347 pwm_config_set_clkdiv_int(&c, 250);
Daniel O'Connor <darius@dons.net.au>
parents: 3
diff changeset
348 // 8Hz
Daniel O'Connor <darius@dons.net.au>
parents: 3
diff changeset
349 pwm_config_set_wrap(&c, 60000 - 1);
Daniel O'Connor <darius@dons.net.au>
parents: 3
diff changeset
350 pwm_init(slice_num, &c, true);
Daniel O'Connor <darius@dons.net.au>
parents: 3
diff changeset
351 pwm_clear_irq(slice_num);
Daniel O'Connor <darius@dons.net.au>
parents: 3
diff changeset
352 pwm_set_irq_enabled(slice_num, true);
Daniel O'Connor <darius@dons.net.au>
parents: 3
diff changeset
353 irq_set_exclusive_handler(PWM_IRQ_WRAP, pwm_wrap);
Daniel O'Connor <darius@dons.net.au>
parents: 3
diff changeset
354 irq_set_enabled(PWM_IRQ_WRAP, true);
Daniel O'Connor <darius@dons.net.au>
parents: 3
diff changeset
355 pwm_init(slice_num, &c, true);
0
a55e39064a71 First commit of code that compiles.
Daniel O'Connor <darius@dons.net.au>
parents:
diff changeset
356
3
b10097c3383d DMA test data repeatedly into PIO FIFO
Daniel O'Connor <darius@dons.net.au>
parents: 2
diff changeset
357 // Everything else from this point is interrupt-driven. The processor has
b10097c3383d DMA test data repeatedly into PIO FIFO
Daniel O'Connor <darius@dons.net.au>
parents: 2
diff changeset
358 // time to sit and think about its early retirement -- maybe open a bakery?
0
a55e39064a71 First commit of code that compiles.
Daniel O'Connor <darius@dons.net.au>
parents:
diff changeset
359 while (true) {
5
Daniel O'Connor <darius@dons.net.au>
parents: 3
diff changeset
360 dma_channel_wait_for_finish_blocking(dma_chan);
Daniel O'Connor <darius@dons.net.au>
parents: 3
diff changeset
361 gpio_put(PICO_DEFAULT_LED_PIN, 1);
Daniel O'Connor <darius@dons.net.au>
parents: 3
diff changeset
362 sleep_ms(100);
Daniel O'Connor <darius@dons.net.au>
parents: 3
diff changeset
363 gpio_put(PICO_DEFAULT_LED_PIN, 0);
2
0d653f60dec8 Actually get data moving out.
Daniel O'Connor <darius@dons.net.au>
parents: 0
diff changeset
364 sleep_ms(100);
0
a55e39064a71 First commit of code that compiles.
Daniel O'Connor <darius@dons.net.au>
parents:
diff changeset
365 }
5
Daniel O'Connor <darius@dons.net.au>
parents: 3
diff changeset
366
Daniel O'Connor <darius@dons.net.au>
parents: 3
diff changeset
367 __breakpoint();
0
a55e39064a71 First commit of code that compiles.
Daniel O'Connor <darius@dons.net.au>
parents:
diff changeset
368 }