From 712b9374af188840b89a36ccc417a8efaf57c76a Mon Sep 17 00:00:00 2001 From: michael Date: Thu, 4 Oct 2018 00:16:21 +0800 Subject: [PATCH] test: modify the command/address test a bit to test the LSBFIRST feature --- components/driver/test/test_spi_master.c | 234 ++++++++++++----------- 1 file changed, 127 insertions(+), 107 deletions(-) diff --git a/components/driver/test/test_spi_master.c b/components/driver/test/test_spi_master.c index 5a7b49010..f2231353b 100644 --- a/components/driver/test/test_spi_master.c +++ b/components/driver/test/test_spi_master.c @@ -756,6 +756,7 @@ static void task_slave(void* arg) t.tx_buffer = txdata.start; t.rx_buffer = recvbuf+8; //loop until trans_len != 0 to skip glitches + memset(recvbuf, 0x66, sizeof(recvbuf)); do { TEST_ESP_OK( spi_slave_transmit( context->spi, &t, portMAX_DELAY ) ); } while ( t.trans_len == 0 ); @@ -766,26 +767,134 @@ static void task_slave(void* arg) } } -TEST_CASE("SPI master variable cmd & addr test","[spi]") +#define TEST_SPI_HOST HSPI_HOST +#define TEST_SLAVE_HOST VSPI_HOST + +static uint8_t bitswap(uint8_t in) { - uint8_t *tx_buf=master_send; - uint8_t rx_buf[320]; - uint8_t *rx_buf_ptr = rx_buf; - - spi_slave_task_context_t slave_context = {}; - esp_err_t err = init_slave_context( &slave_context ); - TEST_ASSERT( err == ESP_OK ); + uint8_t out = 0; + for (int i = 0; i < 8; i++) { + out = out >> 1; + if (in&0x80) out |= 0x80; + in = in << 1; + } + return out; +} +void test_cmd_addr(spi_slave_task_context_t *slave_context, bool lsb_first) +{ spi_device_handle_t spi; + ESP_LOGI(MASTER_TAG, ">>>>>>>>> TEST %s FIRST <<<<<<<<<<<", lsb_first?"LSB":"MSB"); + //initial master, mode 0, 1MHz spi_bus_config_t buscfg=SPI_BUS_TEST_DEFAULT_CONFIG(); - TEST_ESP_OK(spi_bus_initialize(HSPI_HOST, &buscfg, 1)); + TEST_ESP_OK(spi_bus_initialize(TEST_SPI_HOST, &buscfg, 1)); spi_device_interface_config_t devcfg=SPI_DEVICE_TEST_DEFAULT_CONFIG(); - devcfg.clock_speed_hz = 1*1000*1000; //currently only up to 4MHz for internel connect - devcfg.mode = 0; - devcfg.cs_ena_posttrans = 2; - TEST_ESP_OK(spi_bus_add_device(HSPI_HOST, &devcfg, &spi)); + devcfg.clock_speed_hz = 1*1000*1000; + if (lsb_first) devcfg.flags |= SPI_DEVICE_BIT_LSBFIRST; + TEST_ESP_OK(spi_bus_add_device(TEST_SPI_HOST, &devcfg, &spi)); + + //connecting pins to two peripherals breaks the output, fix it. + gpio_output_sel(buscfg.mosi_io_num, FUNC_GPIO, spi_periph_signal[TEST_SPI_HOST].spid_out); + gpio_output_sel(buscfg.miso_io_num, FUNC_GPIO, spi_periph_signal[TEST_SLAVE_HOST].spiq_out); + gpio_output_sel(devcfg.spics_io_num, FUNC_GPIO, spi_periph_signal[TEST_SPI_HOST].spics_out[0]); + gpio_output_sel(buscfg.sclk_io_num, FUNC_GPIO, spi_periph_signal[TEST_SPI_HOST].spiclk_out); + + for (int i= 0; i < 8; i++) { + //prepare slave tx data + slave_txdata_t slave_txdata = (slave_txdata_t) { + .start = slave_send, + .len = 256, + }; + xQueueSend(slave_context->data_to_send, &slave_txdata, portMAX_DELAY); + + vTaskDelay(50); + //prepare master tx data + int cmd_bits = (i+1)*2; + int addr_bits = 56-8*i; + int round_up = (cmd_bits+addr_bits+7)/8*8; + addr_bits = round_up - cmd_bits; + + spi_transaction_ext_t trans = (spi_transaction_ext_t) { + .base = { + .flags = SPI_TRANS_VARIABLE_CMD | SPI_TRANS_VARIABLE_ADDR, + .addr = 0x456789abcdef0123, + .cmd = 0xcdef, + }, + .command_bits = cmd_bits, + .address_bits = addr_bits, + }; + + ESP_LOGI( MASTER_TAG, "===== test%d =====", i ); + ESP_LOGI(MASTER_TAG, "cmd_bits： %d, addr_bits: %d", cmd_bits, addr_bits); + TEST_ESP_OK(spi_device_transmit(spi, (spi_transaction_t*)&trans)); + //wait for both master and slave end + + size_t rcv_len; + slave_rxdata_t *rcv_data = xRingbufferReceive(slave_context->data_received, &rcv_len, portMAX_DELAY); + rcv_len-=8; + uint8_t *buffer = rcv_data->data; + + ESP_LOGI(SLAVE_TAG, "trans_len: %d", rcv_len); + TEST_ASSERT_EQUAL(rcv_len, (rcv_data->len+7)/8); + TEST_ASSERT_EQUAL(rcv_data->len, cmd_bits+addr_bits); + ESP_LOG_BUFFER_HEX("slave rx", buffer, rcv_len); + + uint16_t cmd_expected = trans.base.cmd & (BIT(cmd_bits) - 1); + uint64_t addr_expected = trans.base.addr & ((1ULL<> (16-cmd_bits); + int remain_bits = cmd_bits % 8; + + uint64_t addr_got = *(uint64_t*)data_ptr; + data_ptr += 8; + addr_got = __builtin_bswap64(addr_got); + addr_got = (addr_got << remain_bits); + addr_got |= (*data_ptr >> (8-remain_bits)); + addr_got = addr_got >> (64-addr_bits); + + if (lsb_first) { + cmd_got = __builtin_bswap16(cmd_got); + addr_got = __builtin_bswap64(addr_got); + + uint8_t *swap_ptr = (uint8_t*)&cmd_got; + swap_ptr[0] = bitswap(swap_ptr[0]); + swap_ptr[1] = bitswap(swap_ptr[1]); + cmd_got = cmd_got >> (16-cmd_bits); + + swap_ptr = (uint8_t*)&addr_got; + for (int j = 0; j < 8; j++) swap_ptr[j] = bitswap(swap_ptr[j]); + addr_got = addr_got >> (64-addr_bits); + } + + ESP_LOGI(SLAVE_TAG, "cmd_got: %04X, addr_got: %08X%08X", cmd_got, (uint32_t)(addr_got>>32), (uint32_t)addr_got); + + TEST_ASSERT_EQUAL_HEX16(cmd_expected, cmd_got); + if (addr_bits > 0) { + TEST_ASSERT_EQUAL_HEX32(addr_expected, addr_got); + TEST_ASSERT_EQUAL_HEX32(addr_expected >> 8, addr_got >> 8); + } + + //clean + vRingbufferReturnItem(slave_context->data_received, buffer); + } + + TEST_ASSERT(spi_bus_remove_device(spi) == ESP_OK); + TEST_ASSERT(spi_bus_free(TEST_SPI_HOST) == ESP_OK); +} + +TEST_CASE("SPI master variable cmd & addr test","[spi]") +{ + spi_slave_task_context_t slave_context = {}; + esp_err_t err = init_slave_context( &slave_context ); + TEST_ASSERT( err == ESP_OK ); + TaskHandle_t handle_slave; + xTaskCreate( task_slave, "spi_slave", 4096, &slave_context, 0, &handle_slave); //initial slave, mode 0, no dma int dma_chan = 0; @@ -793,111 +902,22 @@ TEST_CASE("SPI master variable cmd & addr test","[spi]") spi_bus_config_t slv_buscfg=SPI_BUS_TEST_DEFAULT_CONFIG(); spi_slave_interface_config_t slvcfg=SPI_SLAVE_TEST_DEFAULT_CONFIG(); slvcfg.mode = slave_mode; - //Enable pull-ups on SPI lines so we don't detect rogue pulses when no master is connected. - slave_pull_up(&buscfg, slvcfg.spics_io_num); //Initialize SPI slave interface - TEST_ESP_OK( spi_slave_initialize(VSPI_HOST, &slv_buscfg, &slvcfg, dma_chan) ); + TEST_ESP_OK( spi_slave_initialize(TEST_SLAVE_HOST, &slv_buscfg, &slvcfg, dma_chan) ); - - //connecting pins to two peripherals breaks the output, fix it. - gpio_output_sel(PIN_NUM_MOSI, FUNC_GPIO, HSPID_OUT_IDX); - gpio_output_sel(PIN_NUM_MISO, FUNC_GPIO, VSPIQ_OUT_IDX); - gpio_output_sel(PIN_NUM_CS, FUNC_GPIO, HSPICS0_OUT_IDX); - gpio_output_sel(PIN_NUM_CLK, FUNC_GPIO, HSPICLK_OUT_IDX); - - TaskHandle_t handle_slave; - xTaskCreate( task_slave, "spi_slave", 4096, &slave_context, 0, &handle_slave); - - slave_txdata_t slave_txdata[16]; - spi_transaction_ext_t trans[16]; - for( int i= 0; i < 16; i ++ ) { - //prepare slave tx data - slave_txdata[i] = (slave_txdata_t) { - .start = slave_send + 4*(i%3), - .len = 256, - }; - xQueueSend( slave_context.data_to_send, &slave_txdata[i], portMAX_DELAY ); - //prepare master tx data - trans[i] = (spi_transaction_ext_t) { - .base = { - .flags = SPI_TRANS_VARIABLE_CMD | SPI_TRANS_VARIABLE_ADDR, - .addr = 0x456789ab, - .cmd = 0xcdef, - - .length = 8*i, - .tx_buffer = tx_buf+i, - .rx_buffer = rx_buf_ptr, - }, - .command_bits = ((i+1)%3) * 8, - .address_bits = ((i/3)%5) * 8, - }; - if ( trans[i].base.length == 0 ) { - trans[i].base.tx_buffer = NULL; - trans[i].base.rx_buffer = NULL; - } else { - rx_buf_ptr += (trans[i].base.length + 31)/32*4; - } - } - - vTaskDelay(10); - - for ( int i = 0; i < 16; i ++ ) { - TEST_ESP_OK (spi_device_queue_trans( spi, (spi_transaction_t*)&trans[i], portMAX_DELAY ) ); - vTaskDelay(10); - } - - for( int i= 0; i < 16; i ++ ) { - //wait for both master and slave end - ESP_LOGI( MASTER_TAG, "===== test%d =====", i ); - spi_transaction_ext_t *t; - size_t rcv_len; - spi_device_get_trans_result( spi, (spi_transaction_t**)&t, portMAX_DELAY ); - TEST_ASSERT( t == &trans[i] ); - if ( trans[i].base.length != 0 ) { - ESP_LOG_BUFFER_HEX( "master tx", trans[i].base.tx_buffer, trans[i].base.length/8 ); - ESP_LOG_BUFFER_HEX( "master rx", trans[i].base.rx_buffer, trans[i].base.length/8 ); - } else { - ESP_LOGI( "master tx", "no data" ); - ESP_LOGI( "master rx", "no data" ); - } - - slave_rxdata_t *rcv_data = xRingbufferReceive( slave_context.data_received, &rcv_len, portMAX_DELAY ); - uint8_t *buffer = rcv_data->data; - rcv_len = rcv_data->len; - ESP_LOGI(SLAVE_TAG, "trans_len: %d", rcv_len); - ESP_LOG_BUFFER_HEX( "slave tx", slave_txdata[i].start, (rcv_len+7)/8); - ESP_LOG_BUFFER_HEX( "slave rx", buffer, (rcv_len+7)/8); - //check result - uint8_t *ptr_addr = (uint8_t*)&t->base.addr; - uint8_t *ptr_cmd = (uint8_t*)&t->base.cmd; - for ( int j = 0; j < t->command_bits/8; j ++ ) { - TEST_ASSERT_EQUAL( buffer[j], ptr_cmd[t->command_bits/8-j-1] ); - } - for ( int j = 0; j < t->address_bits/8; j ++ ) { - TEST_ASSERT_EQUAL( buffer[t->command_bits/8+j], ptr_addr[t->address_bits/8-j-1] ); - } - if ( t->base.length != 0) { - TEST_ASSERT_EQUAL_HEX8_ARRAY(t->base.tx_buffer, buffer + (t->command_bits + t->address_bits)/8, t->base.length/8); - TEST_ASSERT_EQUAL_HEX8_ARRAY(slave_txdata[i].start + (t->command_bits + t->address_bits)/8, t->base.rx_buffer, t->base.length/8); - } - TEST_ASSERT_EQUAL( t->base.length + t->command_bits + t->address_bits, rcv_len ); - - //clean - vRingbufferReturnItem( slave_context.data_received, buffer ); - } + test_cmd_addr(&slave_context, false); + test_cmd_addr(&slave_context, true); vTaskDelete( handle_slave ); handle_slave = 0; deinit_slave_context(&slave_context); - TEST_ASSERT(spi_slave_free(VSPI_HOST) == ESP_OK); - - TEST_ASSERT(spi_bus_remove_device(spi) == ESP_OK); - TEST_ASSERT(spi_bus_free(HSPI_HOST) == ESP_OK); + TEST_ASSERT(spi_slave_free(TEST_SLAVE_HOST) == ESP_OK); ESP_LOGI(MASTER_TAG, "test passed."); } + /******************************************************************************** * Test Timing By Internal Connections ********************************************************************************/