mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-10-19 14:03:33 +08:00
Added new file for virt dev posix-like functions and test case
Moved posix-like functions to vcdev_posix.cpp and updated the copyright notice. Added test case to make sure poll unblocks when a write occurs. Signed-off-by: Mark Charlebois <charlebm@gmail.com>
This commit is contained in:
@@ -39,6 +39,7 @@
|
||||
* @author Mark Charlebois <charlebm@gmail.com>
|
||||
*/
|
||||
|
||||
#include <px4_tasks.h>
|
||||
#include "vcdevtest_example.h"
|
||||
#include "drivers/device/device.h"
|
||||
#include <unistd.h>
|
||||
@@ -50,13 +51,45 @@ using namespace device;
|
||||
|
||||
#define TESTDEV "/dev/vdevex"
|
||||
|
||||
int writer_main(int argc, char *argv[])
|
||||
{
|
||||
char buf[1] = { '1' };
|
||||
|
||||
int fd = px4_open(TESTDEV, PX4_F_RDONLY);
|
||||
if (fd < 0) {
|
||||
printf("--- Open failed %d %d", fd, px4_errno);
|
||||
return -px4_errno;
|
||||
}
|
||||
|
||||
// Wait for 3 seconds
|
||||
printf("--- Sleeping for 3 sec\n");
|
||||
int ret = sleep(3);
|
||||
if (ret < 0) {
|
||||
printf("--- usleep failed %d %d\n", ret, errno);
|
||||
return ret;
|
||||
}
|
||||
|
||||
printf("--- writing to fd\n");
|
||||
return px4_write(fd, buf, 1);
|
||||
}
|
||||
|
||||
class VCDevNode : public CDev {
|
||||
public:
|
||||
VCDevNode() : CDev("vcdevtest", TESTDEV) {};
|
||||
|
||||
~VCDevNode() {}
|
||||
|
||||
virtual ssize_t write(px4_dev_handle_t *handlep, const char *buffer, size_t buflen);
|
||||
};
|
||||
|
||||
ssize_t VCDevNode::write(px4_dev_handle_t *handlep, const char *buffer, size_t buflen)
|
||||
{
|
||||
// ignore what was written, but let pollers know something was written
|
||||
poll_notify(POLLIN);
|
||||
|
||||
return buflen;
|
||||
}
|
||||
|
||||
VCDevExample::~VCDevExample() {
|
||||
if (_node) {
|
||||
delete _node;
|
||||
@@ -123,6 +156,14 @@ int VCDevExample::main()
|
||||
int i=0;
|
||||
px4_pollfd_struct_t fds[1];
|
||||
|
||||
// Start a task that will write something in 3 seconds
|
||||
(void)px4_task_spawn_cmd("writer",
|
||||
SCHED_DEFAULT,
|
||||
SCHED_PRIORITY_MAX - 6,
|
||||
2000,
|
||||
writer_main,
|
||||
(char* const*)NULL);
|
||||
|
||||
while (!mgr.exitRequested() && i<5) {
|
||||
sleep(2);
|
||||
|
||||
@@ -131,7 +172,9 @@ int VCDevExample::main()
|
||||
fds[0].events = POLLIN;
|
||||
fds[0].revents = 0;
|
||||
|
||||
ret = px4_poll(fds, 1, 500);
|
||||
printf(" Calling Poll\n");
|
||||
ret = px4_poll(fds, 1, 1000);
|
||||
printf(" Done poll\n");
|
||||
if (ret < 0) {
|
||||
printf("poll failed %d %d\n", ret, px4_errno);
|
||||
px4_close(fd);
|
||||
|
||||
@@ -42,11 +42,6 @@
|
||||
#include <px4_tasks.h>
|
||||
#include <stdio.h>
|
||||
#include <string.h>
|
||||
#include <sched.h>
|
||||
|
||||
#define SCHED_DEFAULT SCHED_FIFO
|
||||
#define SCHED_PRIORITY_MAX sched_get_priority_max(SCHED_FIFO)
|
||||
#define SCHED_PRIORITY_DEFAULT sched_get_priority_max(SCHED_FIFO)
|
||||
|
||||
static int daemon_task; /* Handle of deamon task / thread */
|
||||
|
||||
|
||||
@@ -48,6 +48,12 @@
|
||||
typedef int px4_task_t;
|
||||
#elif defined(__PX4_LINUX)
|
||||
#include <pthread.h>
|
||||
#include <sched.h>
|
||||
|
||||
#define SCHED_DEFAULT SCHED_FIFO
|
||||
#define SCHED_PRIORITY_MAX sched_get_priority_max(SCHED_FIFO)
|
||||
#define SCHED_PRIORITY_DEFAULT sched_get_priority_max(SCHED_FIFO)
|
||||
|
||||
typedef pthread_t px4_task_t;
|
||||
|
||||
typedef struct {
|
||||
|
||||
Reference in New Issue
Block a user