Full modbus slave code for PSoC 4, working on Pioneer board