mirror of
https://github.com/drasko/open-ameba.git
synced 2025-01-14 17:25:21 +00:00
138 lines
4.1 KiB
C
138 lines
4.1 KiB
C
/*
|
|
* Routines to access hardware
|
|
*
|
|
* Copyright (c) 2015 Realtek Semiconductor Corp.
|
|
*
|
|
* This module is a confidential and proprietary property of RealTek and
|
|
* possession or use of this module requires written permission of RealTek.
|
|
*/
|
|
#include "FreeRTOS.h"
|
|
#include "task.h"
|
|
#include "diag.h"
|
|
#include "main.h"
|
|
#include "spdio_api.h"
|
|
|
|
/**
|
|
* @brief Main program.
|
|
* @param None
|
|
* @retval None
|
|
*/
|
|
#define EX_SPDIO_STACKSIZE 2048
|
|
#define EX_SPDIO_TX_BD_NUM 24 //n*2, 2 bd for one transaction
|
|
#define EX_SPDIO_RX_BD_NUM 20
|
|
#define EX_SPDIO_RX_BUFSZ (SPDIO_RX_BUFSZ_ALIGN(2048+24)) //n*64, must be rounded to 64, extra 24 bytes for spdio header info
|
|
|
|
struct spdio_t spdio_dev;
|
|
|
|
/*
|
|
* param: pdata, package
|
|
*/
|
|
char ex_spdio_tx(u8 *pdata, u16 size, u8 type){
|
|
static int loop_cnt = 0;
|
|
struct spdio_buf_t *tx_buf = (struct spdio_buf_t *)malloc(sizeof(struct spdio_buf_t));
|
|
memset((u8 *)tx_buf, 0, sizeof(struct spdio_buf_t));
|
|
if(!tx_buf)
|
|
return FAIL;
|
|
tx_buf->buf_allocated = (u32)malloc(size + SPDIO_DMA_ALIGN_4);
|
|
if(!tx_buf->buf_allocated)
|
|
{
|
|
free((u8 *)tx_buf);
|
|
return FAIL;
|
|
}
|
|
tx_buf->size_allocated = size + SPDIO_DMA_ALIGN_4;
|
|
|
|
tx_buf->buf_addr = (u32)N_BYTE_ALIGMENT((u32)(tx_buf->buf_allocated), SPDIO_DMA_ALIGN_4);
|
|
|
|
// copy data
|
|
memcpy((void*)tx_buf->buf_addr, pdata, size);
|
|
|
|
tx_buf->buf_size = size;
|
|
tx_buf->type = SPDIO_RX_DATA_USER; // you can define your own data type in spdio_rx_data_t and spdio_tx_data_t
|
|
printf("loopback package, size = %d (cnt = %d) heap=%d\n", size, ++loop_cnt, xPortGetFreeHeapSize());
|
|
// loopback
|
|
spdio_tx(&spdio_dev, tx_buf);
|
|
return SUCCESS;
|
|
}
|
|
|
|
/*spdio rx done callback (HOST->Device), manage your package and buffer*/
|
|
char ex_spdio_rx_done_cb(void *priv, void *pbuf, u8 *pdata, u16 size, u8 type){
|
|
struct spdio_t *obj = (struct spdio_t *)priv;
|
|
struct spdio_buf_t* rx_buf = (struct spdio_buf_t*)pbuf;
|
|
|
|
// handle package received
|
|
ex_spdio_tx(pdata, size, type);
|
|
|
|
// manage rx_buf here
|
|
free((char *)rx_buf->buf_allocated);
|
|
|
|
// assign new buffer for SPDIO RX
|
|
rx_buf->buf_allocated = (u32)malloc(obj->rx_bd_bufsz + SPDIO_DMA_ALIGN_4);
|
|
rx_buf->size_allocated = obj->rx_bd_bufsz + SPDIO_DMA_ALIGN_4;
|
|
|
|
// this buffer must be 4 byte alignment
|
|
rx_buf->buf_addr = (u32)N_BYTE_ALIGMENT((u32)(rx_buf->buf_allocated), SPDIO_DMA_ALIGN_4);
|
|
|
|
return SUCCESS;
|
|
}
|
|
|
|
/*spdio tx done callback(Device->HOST), manage buffer*/
|
|
// this API will be called after package have been moved to HOST
|
|
char ex_spdio_tx_done_cb(void *priv, void *pbuf){
|
|
|
|
struct spdio_buf_t* tx_buf = (struct spdio_buf_t*)pbuf;
|
|
|
|
free((u8 *)tx_buf->buf_allocated);
|
|
free((u8 *)tx_buf);
|
|
return SUCCESS;
|
|
}
|
|
|
|
|
|
void ex_spdio_thread(void* param){
|
|
|
|
int i;
|
|
|
|
spdio_dev.priv = NULL;
|
|
spdio_dev.rx_bd_num = EX_SPDIO_RX_BD_NUM;
|
|
spdio_dev.tx_bd_num = EX_SPDIO_TX_BD_NUM;
|
|
spdio_dev.rx_bd_bufsz = EX_SPDIO_RX_BUFSZ;
|
|
|
|
spdio_dev.rx_buf = (struct spdio_buf_t *)malloc(spdio_dev.rx_bd_num*sizeof(struct spdio_buf_t));
|
|
if(!spdio_dev.rx_buf){
|
|
printf("malloc failed for spdio buffer structure!\n");
|
|
return;
|
|
}
|
|
|
|
for(i=0;i<spdio_dev.rx_bd_num;i++){
|
|
spdio_dev.rx_buf[i].buf_allocated = (u32)malloc(spdio_dev.rx_bd_bufsz + SPDIO_DMA_ALIGN_4);
|
|
if(!spdio_dev.rx_buf[i].buf_allocated){
|
|
printf("malloc failed for spdio buffer!\n");
|
|
return;
|
|
}
|
|
spdio_dev.rx_buf[i].size_allocated = spdio_dev.rx_bd_bufsz + SPDIO_DMA_ALIGN_4;
|
|
// this buffer must be 4 byte alignment
|
|
spdio_dev.rx_buf[i].buf_addr = (u32)N_BYTE_ALIGMENT((u32)(spdio_dev.rx_buf[i].buf_allocated), SPDIO_DMA_ALIGN_4);
|
|
}
|
|
|
|
spdio_dev.rx_done_cb = ex_spdio_rx_done_cb;
|
|
spdio_dev.tx_done_cb = ex_spdio_tx_done_cb;
|
|
|
|
spdio_init(&spdio_dev);
|
|
printf("SDIO device starts loopback!\n");
|
|
vTaskDelete(NULL);
|
|
}
|
|
|
|
void main(void)
|
|
{
|
|
if(xTaskCreate(ex_spdio_thread, ((const char*)"ex_spdio_thread"), EX_SPDIO_STACKSIZE, NULL, tskIDLE_PRIORITY + 5, NULL) != pdPASS) {
|
|
printf("xTaskCreate(ex_spdio_thread) failed\r\n");
|
|
}
|
|
|
|
//3 3)Enable Schedule, Start Kernel
|
|
#if defined(CONFIG_KERNEL) && !TASK_SCHEDULER_DISABLED
|
|
#ifdef PLATFORM_FREERTOS
|
|
vTaskStartScheduler();
|
|
#endif
|
|
#else
|
|
RtlConsolTaskRom(NULL);
|
|
#endif
|
|
}
|