Skip to content

Commit

Permalink
feat(platform/nuttx): update fs & net & cdcacm support
Browse files Browse the repository at this point in the history
Signed-off-by: sakumisu <[email protected]>
  • Loading branch information
sakumisu committed Jan 23, 2025
1 parent c399be3 commit 2d63459
Show file tree
Hide file tree
Showing 6 changed files with 718 additions and 50 deletions.
1 change: 1 addition & 0 deletions osal/usb_osal_nuttx.c
Original file line number Diff line number Diff line change
Expand Up @@ -131,6 +131,7 @@ int usb_osal_sem_give(usb_osal_sem_t sem)

void usb_osal_sem_reset(usb_osal_sem_t sem)
{
nxsem_reset((sem_t *)sem, 0);
}

usb_osal_mutex_t usb_osal_mutex_create(void)
Expand Down
343 changes: 343 additions & 0 deletions platform/nuttx/usbd_cdcacm.c
Original file line number Diff line number Diff line change
@@ -0,0 +1,343 @@
/*
* Copyright (c) 2025, sakumisu
*
* SPDX-License-Identifier: Apache-2.0
*/
#include <nuttx/kmalloc.h>
#include <nuttx/mutex.h>
#include <nuttx/semaphore.h>
#include <fcntl.h>

#include "usbd_core.h"
#include "usbd_cdc_acm.h"

#include <nuttx/mm/circbuf.h>

#ifndef CONFIG_USBDEV_CDCACM_RXBUFSIZE
#define CONFIG_USBDEV_CDCACM_RXBUFSIZE 512
#endif

#ifndef CONFIG_USBDEV_CDCACM_TXBUFSIZE
#define CONFIG_USBDEV_CDCACM_TXBUFSIZE 512
#endif

USB_NOCACHE_RAM_SECTION struct usbdev_serial_s {
char name[16];
struct circbuf_s circ;
uint8_t inep;
uint8_t outep;
uint32_t rxlen;
int error;
sem_t txdone_sem;
sem_t rxdone_sem;
struct usbd_interface ctrl_intf;
struct usbd_interface data_intf;
__attribute__((aligned(32))) uint8_t cache_tempbuffer[512];
__attribute__((aligned(32))) uint8_t cache_rxbuffer[CONFIG_USBDEV_CDCACM_RXBUFSIZE];
__attribute__((aligned(32))) uint8_t cache_txbuffer[CONFIG_USBDEV_CDCACM_TXBUFSIZE];
};

struct usbdev_serial_s *g_usb_cdcacm_serial[8];

void usbd_cdc_acm_bulk_out1(uint8_t busid, uint8_t ep, uint32_t nbytes)
{
g_usb_cdcacm_serial[0]->error = 0;
g_usb_cdcacm_serial[0]->rxlen = nbytes;
nxsem_post(&g_usb_cdcacm_serial[0]->rxdone_sem);
}

void usbd_cdc_acm_bulk_in1(uint8_t busid, uint8_t ep, uint32_t nbytes)
{
if ((nbytes % usbd_get_ep_mps(busid, ep)) == 0 && nbytes) {
/* send zlp */
usbd_ep_start_write(busid, ep, NULL, 0);
} else {
nxsem_post(&g_usb_cdcacm_serial[0]->txdone_sem);
}
}

void usbd_cdc_acm_bulk_out2(uint8_t busid, uint8_t ep, uint32_t nbytes)
{
g_usb_cdcacm_serial[1]->error = 0;
g_usb_cdcacm_serial[1]->rxlen = nbytes;
nxsem_post(&g_usb_cdcacm_serial[1]->rxdone_sem);
}

void usbd_cdc_acm_bulk_in2(uint8_t busid, uint8_t ep, uint32_t nbytes)
{
if ((nbytes % usbd_get_ep_mps(busid, ep)) == 0 && nbytes) {
/* send zlp */
usbd_ep_start_write(busid, ep, NULL, 0);
} else {
nxsem_post(&g_usb_cdcacm_serial[1]->txdone_sem);
}
}

void usbd_cdc_acm_bulk_out3(uint8_t busid, uint8_t ep, uint32_t nbytes)
{
g_usb_cdcacm_serial[1]->error = 0;
g_usb_cdcacm_serial[2]->rxlen = nbytes;
nxsem_post(&g_usb_cdcacm_serial[2]->rxdone_sem);
}

void usbd_cdc_acm_bulk_in3(uint8_t busid, uint8_t ep, uint32_t nbytes)
{
if ((nbytes % usbd_get_ep_mps(busid, ep)) == 0 && nbytes) {
/* send zlp */
usbd_ep_start_write(busid, ep, NULL, 0);
} else {
nxsem_post(&g_usb_cdcacm_serial[2]->txdone_sem);
}
}

/* Character driver methods */

static int usbdev_open(FAR struct file *filep);
static int usbdev_close(FAR struct file *filep);
static ssize_t usbdev_read(FAR struct file *filep, FAR char *buffer,
size_t buflen);
static ssize_t usbdev_write(FAR struct file *filep,
FAR const char *buffer, size_t buflen);

/****************************************************************************
* Private Data
****************************************************************************/

static const struct file_operations g_usbdevops = {
usbdev_open, /* open */
usbdev_close, /* close */
usbdev_read, /* read */
usbdev_write, /* write */
NULL, /* seek */
NULL, /* ioctl */
NULL, /* mmap */
NULL, /* truncate */
NULL /* poll */
};

static int usbdev_open(FAR struct file *filep)
{
FAR struct inode *inode = filep->f_inode;

DEBUGASSERT(inode->i_private);

if (usb_device_is_configured(0)) {
return OK;
} else {
return -ENODEV;
}
}

static int usbdev_close(FAR struct file *filep)
{
FAR struct inode *inode = filep->f_inode;

DEBUGASSERT(inode->i_private);

if (!usb_device_is_configured(0)) {
return -ENODEV;
}

return 0;
}

static ssize_t usbdev_read(FAR struct file *filep, FAR char *buffer,
size_t buflen)
{
FAR struct inode *inode = filep->f_inode;
struct usbdev_serial_s *serial;
int ret;

DEBUGASSERT(inode->i_private);
serial = (struct usbdev_serial_s *)inode->i_private;

if (!usb_device_is_configured(0)) {
return -ENODEV;
}

while (circbuf_used(&serial->circ) == 0) {
nxsem_reset(&serial->rxdone_sem, 0);
usbd_ep_start_read(0, serial->outep, serial->cache_tempbuffer, usbd_get_ep_mps(0, serial->outep));
ret = nxsem_wait(&serial->rxdone_sem);
if (ret < 0) {
return ret;
}
if (serial->error < 0) {
return serial->error;
}
#if defined(CONFIG_ARCH_DCACHE) && !defined(CONFIG_USB_DCACHE_ENABLE)
up_invalidate_dcache((uintptr_t)serial->cache_tempbuffer, (uintptr_t)(serial->cache_tempbuffer + USB_ALIGN_UP(serial->rxlen, 64)));
#endif
circbuf_overwrite(&serial->circ, serial->cache_tempbuffer, serial->rxlen);
}
return circbuf_read(&serial->circ, buffer, buflen);
}

static ssize_t usbdev_write(FAR struct file *filep, FAR const char *buffer,
size_t buflen)
{
FAR struct inode *inode = filep->f_inode;
struct usbdev_serial_s *serial;
int ret;

DEBUGASSERT(inode->i_private);
serial = (struct usbdev_serial_s *)inode->i_private;

if (!usb_device_is_configured(0)) {
return -ENODEV;
}

#ifdef CONFIG_ARCH_DCACHE
uint32_t write_len = 0;

while (write_len < buflen) {
uint32_t len = buflen - write_len;
if (len > CONFIG_USBDEV_CDCACM_TXBUFSIZE) {
len = CONFIG_USBDEV_CDCACM_TXBUFSIZE;
}
memcpy(serial->cache_txbuffer, buffer + write_len, len);
#ifndef CONFIG_USB_DCACHE_ENABLE
up_clean_dcache((uintptr_t)serial->cache_txbuffer, (uintptr_t)(serial->cache_txbuffer + USB_ALIGN_UP(len, 64)));
#endif
nxsem_reset(&serial->txdone_sem, 0);
usbd_ep_start_write(0, serial->inep, serial->cache_txbuffer, len);
ret = nxsem_wait(&serial->txdone_sem);
if (ret < 0) {
return ret;
} else {
if (serial->error < 0) {
return serial->error;
}
write_len += len;
}
}
return buflen;
#else
nxsem_reset(&serial->txdone_sem, 0);
usbd_ep_start_write(0, serial->inep, buffer, buflen);
ret = nxsem_wait(&serial->txdone_sem);
if (ret < 0) {
return ret;
} else {
return buflen;
}
#endif
}

static struct usbd_endpoint cdc_out_ep[8] = {
{ .ep_addr = 0,
.ep_cb = usbd_cdc_acm_bulk_out1 },
{ .ep_addr = 0,
.ep_cb = usbd_cdc_acm_bulk_out2 },
{ .ep_addr = 0,
.ep_cb = usbd_cdc_acm_bulk_out3 }
};

static struct usbd_endpoint cdc_in_ep[8] = {
{ .ep_addr = 0,
.ep_cb = usbd_cdc_acm_bulk_in1 },
{ .ep_addr = 0,
.ep_cb = usbd_cdc_acm_bulk_in2 },
{ .ep_addr = 0,
.ep_cb = usbd_cdc_acm_bulk_in3 }
};

static void cdcacm_notify_handler1(uint8_t busid, uint8_t event, void *arg)
{
switch (event) {
case USBD_EVENT_RESET:
break;
case USBD_EVENT_DISCONNECTED:
g_usb_cdcacm_serial[0]->error = -ENOTCONN;
nxsem_post(&g_usb_cdcacm_serial[0]->txdone_sem);
nxsem_post(&g_usb_cdcacm_serial[0]->rxdone_sem);
break;

case USBD_EVENT_CONFIGURED:
nxsem_post(&g_usb_cdcacm_serial[0]->txdone_sem);
nxsem_post(&g_usb_cdcacm_serial[0]->rxdone_sem);
break;
default:
break;
}
}

static void cdcacm_notify_handler2(uint8_t busid, uint8_t event, void *arg)
{
switch (event) {
case USBD_EVENT_RESET:
break;
case USBD_EVENT_DISCONNECTED:
g_usb_cdcacm_serial[1]->error = -ENOTCONN;
nxsem_post(&g_usb_cdcacm_serial[1]->txdone_sem);
nxsem_post(&g_usb_cdcacm_serial[1]->rxdone_sem);
break;

case USBD_EVENT_CONFIGURED:
nxsem_post(&g_usb_cdcacm_serial[1]->txdone_sem);
nxsem_post(&g_usb_cdcacm_serial[1]->rxdone_sem);
break;
default:
break;
}
}

static void cdcacm_notify_handler3(uint8_t busid, uint8_t event, void *arg)
{
switch (event) {
case USBD_EVENT_RESET:
break;
case USBD_EVENT_DISCONNECTED:
g_usb_cdcacm_serial[2]->error = -ENOTCONN;
nxsem_post(&g_usb_cdcacm_serial[2]->txdone_sem);
nxsem_post(&g_usb_cdcacm_serial[2]->rxdone_sem);
break;

case USBD_EVENT_CONFIGURED:
nxsem_post(&g_usb_cdcacm_serial[2]->txdone_sem);
nxsem_post(&g_usb_cdcacm_serial[2]->rxdone_sem);
break;
default:
break;
}
}

usbd_notify_handler cdcacm_notify_handler[8] = {
cdcacm_notify_handler1,
cdcacm_notify_handler2,
cdcacm_notify_handler3
};

void usbd_cdcacm_init(uint8_t busid, uint8_t id, const char *path, uint8_t outep, uint8_t inep)
{
g_usb_cdcacm_serial[id] = kmm_malloc(sizeof(struct usbdev_serial_s));
DEBUGASSERT(g_usb_cdcacm_serial[id]);

memset(g_usb_cdcacm_serial[id], 0, sizeof(struct usbdev_serial_s));
strncpy(g_usb_cdcacm_serial[id]->name, path, sizeof(g_usb_cdcacm_serial[id]->name) - 1);

circbuf_init(&g_usb_cdcacm_serial[id]->circ, g_usb_cdcacm_serial[id]->cache_rxbuffer, CONFIG_USBDEV_CDCACM_RXBUFSIZE);

nxsem_init(&g_usb_cdcacm_serial[id]->rxdone_sem, 0, 0);
nxsem_init(&g_usb_cdcacm_serial[id]->txdone_sem, 0, 0);

usbd_add_interface(busid, usbd_cdc_acm_init_intf(busid, &g_usb_cdcacm_serial[id]->ctrl_intf));
usbd_add_interface(busid, usbd_cdc_acm_init_intf(busid, &g_usb_cdcacm_serial[id]->data_intf));
g_usb_cdcacm_serial[id]->ctrl_intf.notify_handler = cdcacm_notify_handler[id];

cdc_out_ep[id].ep_addr = outep;
cdc_in_ep[id].ep_addr = inep;
g_usb_cdcacm_serial[id]->outep = outep;
g_usb_cdcacm_serial[id]->inep = inep;
usbd_add_endpoint(busid, &cdc_out_ep[id]);
usbd_add_endpoint(busid, &cdc_in_ep[id]);

register_driver(path, &g_usbdevops, 0666, g_usb_cdcacm_serial[id]);
}

void usbd_cdcacm_deinit(uint8_t busid, uint8_t id)
{
unregister_driver(g_usb_cdcacm_serial[id]->name);

kmm_free(g_usb_cdcacm_serial[id]);
}
Loading

0 comments on commit 2d63459

Please sign in to comment.