dark0707
/
px4-firmware
forked from Archive/PX4-Autopilot
1
0
Fork 0
Code Pull Requests Activity

Merge branch 'master' of github.com:PX4/Firmware into fixedwing_io_mixing

This commit is contained in:
Lorenz Meier 2013-01-06 01:32:55 +01:00
parent 83039e76d3 69cdab9afc
commit ad7637861d
3 changed files with 42 additions and 3 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

2
apps/drivers/px4fmu/fmu.cpp
View File

@ -539,7 +539,7 @@ PX4FMU::pwm_ioctl(file *filp, int cmd, unsigned long arg)
/* FALLTHROUGH */ /* FALLTHROUGH */
case PWM_SERVO_GET(0): case PWM_SERVO_GET(0):
case PWM_SERVO_GET(1): { case PWM_SERVO_GET(1): {
channel = cmd - PWM_SERVO_SET(0); channel = cmd - PWM_SERVO_GET(0);
*(servo_position_t *)arg = up_pwm_servo_get(channel); *(servo_position_t *)arg = up_pwm_servo_get(channel);
break; break;
} }

39
nuttx/drivers/serial/serial.c
View File

@ -660,9 +660,9 @@ static int uart_ioctl(FAR struct file *filep, int cmd, unsigned long arg)
int ret = dev->ops->ioctl(filep, cmd, arg); int ret = dev->ops->ioctl(filep, cmd, arg);
/* Append any higher level TTY flags */ /* If the low-level handler didn't handle the call, see if we can handle it here */
if (ret == OK) if (ret == -ENOTTY)
{ {
switch (cmd) switch (cmd)
{ {
@ -686,8 +686,43 @@ static int uart_ioctl(FAR struct file *filep, int cmd, unsigned long arg)
irqrestore(state); irqrestore(state);
*(int *)arg = count; *(int *)arg = count;
ret = 0;
break;
} }
case FIONWRITE:
{
int count;
irqstate_t state = irqsave();
/* determine the number of bytes free in the buffer */
if (dev->xmit.head < dev->xmit.tail)
{
count = dev->xmit.tail - dev->xmit.head - 1;
}
else
{
count = dev->xmit.size - (dev->xmit.head - dev->xmit.tail) - 1;
}
irqrestore(state);
*(int *)arg = count;
ret = 0;
break;
}
}
}
/* Append any higher level TTY flags */
else if (ret == OK)
{
switch (cmd)
{
#ifdef CONFIG_SERIAL_TERMIOS #ifdef CONFIG_SERIAL_TERMIOS
case TCGETS: case TCGETS:
{ {

4
nuttx/include/nuttx/fs/ioctl.h
View File

@ -110,6 +110,10 @@
* OUT: Bytes readable from this fd * OUT: Bytes readable from this fd
*/ */
#define FIONWRITE _FIOC(0x0005) /* IN: Location to return value (int *)
* OUT: Bytes writable to this fd
*/
/* NuttX file system ioctl definitions **************************************/ /* NuttX file system ioctl definitions **************************************/
#define _DIOCVALID(c) (_IOC_TYPE(c)==_DIOCBASE) #define _DIOCVALID(c) (_IOC_TYPE(c)==_DIOCBASE)