mirror of
https://github.com/stacksmashing/pico-tpmsniffer.git
synced 2026-01-30 18:28:38 +03:00
66 lines
1.8 KiB
Plaintext
66 lines
1.8 KiB
Plaintext
|
; All rights reserved. Copyright by Thomas Roth. code@stacksmashing.net
|
||
|
|
|
||
|
|
.program lpc_sniffer
|
||
|
|
.side_set 1 opt
|
||
|
|
|
||
|
|
entry:
|
||
|
|
; Wait for LFRAME (ABSOLUTE pin 0) to go low
|
||
|
|
SET X, 15 side 0
|
||
|
|
WAIT 1 GPIO 5
|
||
|
|
WAIT 0 GPIO 5; ~0ns
|
||
|
|
NOP
|
||
|
|
NOP
|
||
|
|
NOP
|
||
|
|
NOP
|
||
|
|
read_target:
|
||
|
|
IN PINS 4 side 1; starts at ~20ns | read 0/40ns
|
||
|
|
NOP side 1; first: 10ns | 30ns second round
|
||
|
|
NOP side 0 [3]; read 10ns
|
||
|
|
JMP X-- read_target [1] side 0 ; read 20ns
|
||
|
|
PUSH
|
||
|
|
|
||
|
|
JMP entry
|
||
|
|
|
||
|
|
% c-sdk {
|
||
|
|
static inline void lpc_sniffer_program_init(PIO pio, uint sm, uint offset, uint base_pin, uint debug_pin) {
|
||
|
|
pio_sm_config c = lpc_sniffer_program_get_default_config(offset);
|
||
|
|
|
||
|
|
// We have no out pins
|
||
|
|
// sm_config_set_out_pins(&c, base_pin, 1);
|
||
|
|
|
||
|
|
//pio_gpio_init(pio, 0);
|
||
|
|
for(int i=0; i < 4; i++) {
|
||
|
|
pio_gpio_init(pio, base_pin + i);
|
||
|
|
}
|
||
|
|
//hw_set_bits(&pio->input_sync_bypass, 1);
|
||
|
|
|
||
|
|
// frame pin
|
||
|
|
pio_gpio_init(pio, 0);
|
||
|
|
pio_gpio_init(pio, 5);
|
||
|
|
|
||
|
|
pio_gpio_init(pio, debug_pin);
|
||
|
|
|
||
|
|
// Set all 4 pins to input (false = input)
|
||
|
|
pio_sm_set_consecutive_pindirs(pio, sm, 0, 1, false);
|
||
|
|
pio_sm_set_consecutive_pindirs(pio, sm, base_pin, 4, false);
|
||
|
|
sm_config_set_in_pins(&c, base_pin);
|
||
|
|
|
||
|
|
sm_config_set_sideset_pins(&c, debug_pin);
|
||
|
|
pio_sm_set_consecutive_pindirs(pio, sm, debug_pin, 1, true);
|
||
|
|
|
||
|
|
sm_config_set_in_shift (&c, false, true, 32);
|
||
|
|
|
||
|
|
|
||
|
|
// Chain FIFOs together as we will *only* receive.
|
||
|
|
// This will ensure we will not block.
|
||
|
|
sm_config_set_fifo_join(&c, PIO_FIFO_JOIN_RX);
|
||
|
|
|
||
|
|
float div = (float)clock_get_hz(clk_sys) / 200000000.0;
|
||
|
|
sm_config_set_clkdiv(&c, div);
|
||
|
|
|
||
|
|
// Load our configuration, and jump to the start of the program
|
||
|
|
pio_sm_init(pio, sm, offset, &c);
|
||
|
|
// Set the state machine running
|
||
|
|
pio_sm_set_enabled(pio, sm, true);
|
||
|
|
}
|
||
|
|
%}
|