spacepaste

  1.  
  2. import time
  3. import microcontroller
  4. import digitalio
  5. class SWD:
  6. def __init__(swdio, swclk):
  7. self.swdio = swdio
  8. self.swclk = swclk
  9. def swd_setup(self):
  10. self.swclk = digitalio.DigitalInOut(swclk)
  11. self.swclk.switch_to_output()
  12. self.swclk.value = 1
  13. self.swdio = digitalio.DigitalInOut(swdio)
  14. self.swdio.switch_to_output()
  15. self.swdio.value = 1
  16. def sw_clk_cycle(self):
  17. self.swclk.value = 0
  18. microontroller.delay_us(1)
  19. self.swclk.value = 1
  20. microcontroller.delay_us(1)
  21. def sw_write_bit(self, bit):
  22. self.swdio.switch_to_output()
  23. self.swdio.value = bit
  24. self.swclk.value = 0
  25. microcontroller.delay_us(1)
  26. self.swclk.value = 1
  27. microcontroller.delay_us(1)
  28. def sw_read_bit(self):
  29. self.swclk.value = 0
  30. microcontroller.delay_us(1)
  31. self.swdio.switch_to_input()
  32. bit = swdio.value
  33. self.swclk.value = 1
  34. microcontroller.delay_us(1)
  35. return bit
  36. def swd_transfer(self, request, data):
  37. parity = 0
  38. self.sw_write_bit(1)
  39. bit = request >> 0
  40. self.sw_write_bit(bit)
  41. parity += bit
  42. bit = request >> 1
  43. self.sw_write_bit(bit)
  44. parity += bit
  45. bit = request >> 2
  46. self.sw_write_bit(bit)
  47. parity += bit
  48. bit = request >> 3
  49. self.sw_write_bit(bit)
  50. parity += bit
  51. self.sw_write_bit(parity)
  52. self.sw_write_bit(0)
  53. self.sw_write_bit(1)
  54.