# test SPI communication

import time
from machine import Pin, SoftSPI

spi = SoftSPI(baudrate=1000000, sck=Pin(18), mosi=Pin(23), miso=Pin(19))
cs = Pin(5, Pin.OUT,value=1)
spi.init(baudrate=1000000)

q1 = 12.5654
q1d = 4.2349
q1dd =  -0.1509

q2 = -5.0234
q2d = 7.9214
q2dd =  1.1426

spi_str = str(q1)+","+str(q1d)+","+str(q1dd)+","+str(q2)+","+str(q2d)+","+str(q2dd)+"\n"
spi_str+="                                                                "
txdata = spi_str #b"Hello SPI! "
rxdata = bytearray(len(txdata))
try:
    cs(0)                               # Select peripheral.
    spi.write_readinto(txdata, rxdata)  # Simultaneously write and read bytes.
finally:
    cs(1)     # Deselect peripheral.

print(rxdata)