Mirrors_Framework/PX4-Autopilot
1
0
Fork 0
mirror of https://github.com/PX4/PX4-Autopilot.git synced 2026-05-23 14:47:44 +08:00
Code Issues Actions 16 Packages Projects Releases Wiki Activity

cdev: fixes hardfaults when device get disconnected (#17846)

Browse Source 
check if inode is not unlinked before use
This commit is contained in:
Oleg Evseev
2021-07-05 14:31:07 +03:00
committed by Daniel Agar
parent a5ee28883a
commit f296a41737
1 changed files with 31 additions and 2 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/lib/cdev/nuttx/cdev_platform.cpp
+31 -2
View File
@@ -1,6 +1,6 @@
/****************************************************************************
*
* Copyright (c) 2012-2014 PX4 Development Team. All rights reserved.
* Copyright (c) 2012-2021 PX4 Development Team. All rights reserved.
*
* Redistribution and use in source and binary forms, with or without
* modification, are permitted provided that the following conditions
@@ -36,10 +36,11 @@
*
* NuttX Character device functions
*/
#include <errno.h>
#include "cdev_platform.hpp"
#include "../CDev.hpp"
#include <px4_platform_common/posix.h>
#include <sys/ioctl.h>
#ifdef CONFIG_DISABLE_POLL
@@ -86,6 +87,10 @@ unlink : nullptr
static int
cdev_open(file_t *filp)
{
if ((filp->f_inode->i_flags & FSNODEFLAG_DELETED) != 0) {
return -ENODEV;
}
cdev::CDev *cdev = (cdev::CDev *)(filp->f_inode->i_private);
return cdev->open(filp);
@@ -94,6 +99,10 @@ cdev_open(file_t *filp)
static int
cdev_close(file_t *filp)
{
if ((filp->f_inode->i_flags & FSNODEFLAG_DELETED) != 0) {
return -ENODEV;
}
cdev::CDev *cdev = (cdev::CDev *)(filp->f_inode->i_private);
return cdev->close(filp);
@@ -102,6 +111,10 @@ cdev_close(file_t *filp)
static ssize_t
cdev_read(file_t *filp, char *buffer, size_t buflen)
{
if ((filp->f_inode->i_flags & FSNODEFLAG_DELETED) != 0) {
return -ENODEV;
}
cdev::CDev *cdev = (cdev::CDev *)(filp->f_inode->i_private);
return cdev->read(filp, buffer, buflen);
@@ -110,6 +123,10 @@ cdev_read(file_t *filp, char *buffer, size_t buflen)
static ssize_t
cdev_write(file_t *filp, const char *buffer, size_t buflen)
{
if ((filp->f_inode->i_flags & FSNODEFLAG_DELETED) != 0) {
return -ENODEV;
}
cdev::CDev *cdev = (cdev::CDev *)(filp->f_inode->i_private);
return cdev->write(filp, buffer, buflen);
@@ -118,6 +135,10 @@ cdev_write(file_t *filp, const char *buffer, size_t buflen)
static off_t
cdev_seek(file_t *filp, off_t offset, int whence)
{
if ((filp->f_inode->i_flags & FSNODEFLAG_DELETED) != 0) {
return -ENODEV;
}
cdev::CDev *cdev = (cdev::CDev *)(filp->f_inode->i_private);
return cdev->seek(filp, offset, whence);
@@ -126,6 +147,10 @@ cdev_seek(file_t *filp, off_t offset, int whence)
static int
cdev_ioctl(file_t *filp, int cmd, unsigned long arg)
{
if ((filp->f_inode->i_flags & FSNODEFLAG_DELETED) != 0) {
return -ENODEV;
}
cdev::CDev *cdev = (cdev::CDev *)(filp->f_inode->i_private);
return cdev->ioctl(filp, cmd, arg);
@@ -134,6 +159,10 @@ cdev_ioctl(file_t *filp, int cmd, unsigned long arg)
static int
cdev_poll(file_t *filp, px4_pollfd_struct_t *fds, bool setup)
{
if ((filp->f_inode->i_flags & FSNODEFLAG_DELETED) != 0) {
return -ENODEV;
}
cdev::CDev *cdev = (cdev::CDev *)(filp->f_inode->i_private);
return cdev->poll(filp, fds, setup);