| /* |
| * The MIT License (MIT) |
| * |
| * Copyright (c) 2021 Raspberry Pi (Trading) Ltd. |
| * |
| * Permission is hereby granted, free of charge, to any person obtaining a copy |
| * of this software and associated documentation files (the "Software"), to deal |
| * in the Software without restriction, including without limitation the rights |
| * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell |
| * copies of the Software, and to permit persons to whom the Software is |
| * furnished to do so, subject to the following conditions: |
| * |
| * The above copyright notice and this permission notice shall be included in |
| * all copies or substantial portions of the Software. |
| * |
| * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR |
| * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, |
| * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE |
| * AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER |
| * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, |
| * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN |
| * THE SOFTWARE. |
| * |
| */ |
| |
| .program probe |
| .side_set 1 opt |
| |
| public out_negedge: |
| set pindirs, 1 side 0x0 ; Init OE clock 0 |
| public out_idle: |
| pull ; Pull number of bits to shift -1 from tx fifo and put into output shift register |
| mov x, osr ; mov bits to shift -1 from output shift register into x |
| pull ; Pull data to shift out |
| out_negedge_bitloop: |
| out pins, 1 side 0x0 ; clock data out on falling edge |
| jmp x-- out_negedge_bitloop side 0x1 ; data is present for posedge |
| set pins, 1 side 0x0 ; Drive data high (idle bus state) |
| push ; Push to rx fifo just so processor knows when done |
| jmp out_negedge ; Wait for next transaction |
| |
| public in_posedge: |
| set pindirs, 0 side 0x0 ; INIT IE clock 0 |
| public in_idle: |
| pull ; Pull number of bits to shift -1 from tx fifo and put into output shift register |
| mov x, osr ; mov bits to shift -1 from output shift register into x into x |
| in_posedge_bitloop: |
| in pins, 1 side 0x1 ; Generate posedge and read data |
| jmp x-- in_posedge_bitloop side 0x0 ; |
| push ; Push to rx fifo when done |
| jmp in_posedge ; Jump back to start |
| |
| ; Implement probe_gpio_init() and probe_sm_init() methods here - set pins, offsets, sidesets etc |
| % c-sdk { |
| |
| static inline void probe_gpio_init() |
| { |
| #if defined(PROBE_PIN_RESET) |
| // Target reset pin: pull up, input to emulate open drain pin |
| gpio_pull_up(PROBE_PIN_RESET); |
| // gpio_init will leave the pin cleared and set as input |
| gpio_init(PROBE_PIN_RESET); |
| #endif |
| // Funcsel pins |
| pio_gpio_init(pio0, PROBE_PIN_SWCLK); |
| pio_gpio_init(pio0, PROBE_PIN_SWDIO); |
| // Make sure SWDIO has a pullup on it. Idle state is high |
| gpio_pull_up(PROBE_PIN_SWDIO); |
| } |
| |
| static inline void probe_sm_init(pio_sm_config* sm_config) { |
| |
| // Set SWCLK as a sideset pin |
| sm_config_set_sideset_pins(sm_config, PROBE_PIN_SWCLK); |
| |
| // Set SWDIO offset |
| sm_config_set_out_pins(sm_config, PROBE_PIN_SWDIO, 1); |
| sm_config_set_set_pins(sm_config, PROBE_PIN_SWDIO, 1); |
| #ifdef PROBE_IO_SWDI |
| sm_config_set_in_pins(sm_config, PROBE_PIN_SWDI); |
| #else |
| sm_config_set_in_pins(sm_config, PROBE_PIN_SWDIO); |
| #endif |
| |
| |
| // Set SWD and SWDIO pins as output to start. This will be set in the sm |
| pio_sm_set_consecutive_pindirs(pio0, PROBE_SM, PROBE_PIN_OFFSET, 2, true); |
| |
| // shift output right, autopull off, autopull threshold |
| sm_config_set_out_shift(sm_config, true, false, 0); |
| // shift input right as swd data is lsb first, autopush off |
| sm_config_set_in_shift(sm_config, true, false, 0); |
| } |
| |
| %} |