Make common_arm to hardware abstraction layer.
This commit is contained in:
1 parent
51d0ff260a
commit
36f1c7e44c
61 files changed
+8050
-1670
No files matched your search
@@ -0,0 +1,97 @@
|
||||
#include "string.h"
|
||||
#include "usb_read_ng.h"
|
||||
|
||||
static const usb_read_ng_config_t *g_config = NULL;
|
||||
static size_t g_buf_len = 0;
|
||||
static size_t g_buf_offset = 0;
|
||||
|
||||
#ifndef MIN
|
||||
#define MIN(a, b) ((a) < (b) ? (a) : (b))
|
||||
#endif
|
||||
|
||||
void usb_read_ng_init(const usb_read_ng_config_t *config)
|
||||
{
|
||||
if (!config || !config->is_link_ready || !config->is_data_ready ||
|
||||
!config->get_byte_count || !config->read_fifo ||
|
||||
!config->clear_ready || !config->buffer || config->buffer_size == 0) {
|
||||
return;
|
||||
}
|
||||
g_config = config;
|
||||
g_buf_len = 0;
|
||||
g_buf_offset = 0;
|
||||
}
|
||||
|
||||
bool usb_read_ng_has_buffered_data(void)
|
||||
{
|
||||
return g_buf_len > 0;
|
||||
}
|
||||
|
||||
uint32_t usb_read_ng(uint8_t *data, size_t len)
|
||||
{
|
||||
if (!g_config || !data || len == 0) {
|
||||
return 0;
|
||||
}
|
||||
|
||||
uint32_t nbBytesRcv = 0;
|
||||
uint16_t time_out = 0;
|
||||
const uint16_t timeout_limit = g_config->timeout; // Timeout value of platform
|
||||
|
||||
// First from buffer of this module.
|
||||
if (len <= g_buf_len) {
|
||||
memcpy(data, g_config->buffer + g_buf_offset, len);
|
||||
g_buf_len -= len;
|
||||
g_buf_offset = g_buf_len ? g_buf_offset + len : 0;
|
||||
return len;
|
||||
}
|
||||
|
||||
if (g_buf_len > 0) {
|
||||
memcpy(data, g_config->buffer + g_buf_offset, g_buf_len);
|
||||
nbBytesRcv = g_buf_len;
|
||||
len -= g_buf_len;
|
||||
g_buf_len = 0;
|
||||
g_buf_offset = 0;
|
||||
}
|
||||
|
||||
while (len > 0) {
|
||||
// 1. if usb status is disconnected or unopened, exit read for device side.
|
||||
if (!g_config->is_link_ready()) {
|
||||
break;
|
||||
}
|
||||
|
||||
// 2. check if data ready for usb device, if not, skip read and check timeout.
|
||||
if (g_config->is_data_ready()) {
|
||||
uint16_t available = g_config->get_byte_count();
|
||||
uint16_t packetSize = MIN(available, len);
|
||||
|
||||
for (uint16_t i = 0; i < packetSize; i++) {
|
||||
data[nbBytesRcv++] = g_config->read_fifo(); // read from device fifo.
|
||||
}
|
||||
available -= packetSize;
|
||||
len -= packetSize;
|
||||
|
||||
size_t to_buffer = (available < g_config->buffer_size) ? available : g_config->buffer_size;
|
||||
for (size_t i = 0; i < to_buffer; i++) {
|
||||
g_config->buffer[i] = g_config->read_fifo();
|
||||
}
|
||||
g_buf_len = to_buffer;
|
||||
g_buf_offset = 0;
|
||||
|
||||
// gc gc gc gc !!!
|
||||
g_config->clear_ready();
|
||||
time_out = 0; // Timeout reset.
|
||||
}
|
||||
else {
|
||||
// usb link ready but no data. to check simple timeout.
|
||||
if (timeout_limit > 0) {
|
||||
time_out++;
|
||||
if (time_out >= timeout_limit) {
|
||||
break; // exit if timeout.
|
||||
}
|
||||
} else {
|
||||
break; // no timeout. exit immediately.
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
return nbBytesRcv;
|
||||
}
|
||||
Reference in new issue
Block a user