Change implementation of SPI, add test bench, update docs

Change implementation of SPI, add test bench, update docs #4