apps/examples/gpio: Add a simple test of the GPIO driver
This commit is contained in:
parent
ac018597e4
commit
acbbd690f9
@ -553,6 +553,11 @@ examples/ftpd
|
|||||||
CONFIG_NETUTILS_NETLIB=y
|
CONFIG_NETUTILS_NETLIB=y
|
||||||
CONFIG_NETUTILS_TELNED=y
|
CONFIG_NETUTILS_TELNED=y
|
||||||
|
|
||||||
|
examples/gpio
|
||||||
|
^^^^^^^^^^^^
|
||||||
|
|
||||||
|
A simple test/example of the NuttX GPIO driver.
|
||||||
|
|
||||||
examples/hello
|
examples/hello
|
||||||
^^^^^^^^^^^^^^
|
^^^^^^^^^^^^^^
|
||||||
|
|
||||||
@ -648,8 +653,8 @@ examples/igmp
|
|||||||
* CONFIG_EXAMPLES_NETLIB
|
* CONFIG_EXAMPLES_NETLIB
|
||||||
The networking library is needed
|
The networking library is needed
|
||||||
|
|
||||||
examples/adc
|
examples/i2cchar
|
||||||
^^^^^^^^^^^^
|
^^^^^^^^^^^^^^^^
|
||||||
|
|
||||||
A mindlessly simple test of an I2C driver. It reads an write garbage data to the
|
A mindlessly simple test of an I2C driver. It reads an write garbage data to the
|
||||||
I2C transmitter and/or received as fast possible.
|
I2C transmitter and/or received as fast possible.
|
||||||
@ -741,7 +746,7 @@ examples/lcdrw
|
|||||||
NuttX is built as a protected, supervisor kernel (CONFIG_BUILD_PROTECTED
|
NuttX is built as a protected, supervisor kernel (CONFIG_BUILD_PROTECTED
|
||||||
or CONFIG_BUILD_KERNEL).
|
or CONFIG_BUILD_KERNEL).
|
||||||
|
|
||||||
examples/adc
|
examples/leds
|
||||||
^^^^^^^^^^^^
|
^^^^^^^^^^^^
|
||||||
This is a simple test of the board LED driver at nuttx/drivers/leds/userled_*.c.
|
This is a simple test of the board LED driver at nuttx/drivers/leds/userled_*.c.
|
||||||
|
|
||||||
|
11
examples/gpio/.gitignore
vendored
Normal file
11
examples/gpio/.gitignore
vendored
Normal file
@ -0,0 +1,11 @@
|
|||||||
|
/Make.dep
|
||||||
|
/.depend
|
||||||
|
/.built
|
||||||
|
/*.asm
|
||||||
|
/*.obj
|
||||||
|
/*.rel
|
||||||
|
/*.lst
|
||||||
|
/*.sym
|
||||||
|
/*.adb
|
||||||
|
/*.lib
|
||||||
|
/*.src
|
31
examples/gpio/Kconfig
Normal file
31
examples/gpio/Kconfig
Normal file
@ -0,0 +1,31 @@
|
|||||||
|
#
|
||||||
|
# For a description of the syntax of this configuration file,
|
||||||
|
# see the file kconfig-language.txt in the NuttX tools repository.
|
||||||
|
#
|
||||||
|
|
||||||
|
config EXAMPLES_GPIO
|
||||||
|
bool "GPIO driver example"
|
||||||
|
default n
|
||||||
|
depends on DEV_GPIO
|
||||||
|
---help---
|
||||||
|
Enable the GPIO driver example
|
||||||
|
|
||||||
|
if EXAMPLES_GPIO
|
||||||
|
|
||||||
|
config EXAMPLES_GPIO_PROGNAME
|
||||||
|
string "Program name"
|
||||||
|
default "gpio"
|
||||||
|
depends on BUILD_KERNEL
|
||||||
|
---help---
|
||||||
|
This is the name of the program that will be use when the NSH ELF
|
||||||
|
program is installed.
|
||||||
|
|
||||||
|
config EXAMPLES_GPIO_PRIORITY
|
||||||
|
int "GPIO task priority"
|
||||||
|
default 100
|
||||||
|
|
||||||
|
config EXAMPLES_GPIO_STACKSIZE
|
||||||
|
int "GPIO stack size"
|
||||||
|
default 2048
|
||||||
|
|
||||||
|
endif
|
39
examples/gpio/Make.defs
Normal file
39
examples/gpio/Make.defs
Normal file
@ -0,0 +1,39 @@
|
|||||||
|
############################################################################
|
||||||
|
# apps/examples/gpio/Make.defs
|
||||||
|
# Adds selected applications to apps/ build
|
||||||
|
#
|
||||||
|
# Copyright (C) 2015 Gregory Nutt. All rights reserved.
|
||||||
|
# Author: Gregory Nutt <gnutt@nuttx.org>
|
||||||
|
#
|
||||||
|
# Redistribution and use in source and binary forms, with or without
|
||||||
|
# modification, are permitted provided that the following conditions
|
||||||
|
# are met:
|
||||||
|
#
|
||||||
|
# 1. Redistributions of source code must retain the above copyright
|
||||||
|
# notice, this list of conditions and the following disclaimer.
|
||||||
|
# 2. Redistributions in binary form must reproduce the above copyright
|
||||||
|
# notice, this list of conditions and the following disclaimer in
|
||||||
|
# the documentation and/or other materials provided with the
|
||||||
|
# distribution.
|
||||||
|
# 3. Neither the name NuttX nor the names of its contributors may be
|
||||||
|
# used to endorse or promote products derived from this software
|
||||||
|
# without specific prior written permission.
|
||||||
|
#
|
||||||
|
# THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
|
||||||
|
# "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
|
||||||
|
# LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
|
||||||
|
# FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE
|
||||||
|
# COPYRIGHT OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT,
|
||||||
|
# INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
|
||||||
|
# BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS
|
||||||
|
# OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED
|
||||||
|
# AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
|
||||||
|
# LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN
|
||||||
|
# ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
|
||||||
|
# POSSIBILITY OF SUCH DAMAGE.
|
||||||
|
#
|
||||||
|
############################################################################
|
||||||
|
|
||||||
|
ifeq ($(CONFIG_EXAMPLES_GPIO),y)
|
||||||
|
CONFIGURED_APPS += examples/gpio
|
||||||
|
endif
|
56
examples/gpio/Makefile
Normal file
56
examples/gpio/Makefile
Normal file
@ -0,0 +1,56 @@
|
|||||||
|
############################################################################
|
||||||
|
# apps/examples/gpio/Makefile
|
||||||
|
#
|
||||||
|
# Copyright (C) 2008, 2010-2013 Gregory Nutt. All rights reserved.
|
||||||
|
# Author: Gregory Nutt <gnutt@nuttx.org>
|
||||||
|
#
|
||||||
|
# Redistribution and use in source and binary forms, with or without
|
||||||
|
# modification, are permitted provided that the following conditions
|
||||||
|
# are met:
|
||||||
|
#
|
||||||
|
# 1. Redistributions of source code must retain the above copyright
|
||||||
|
# notice, this list of conditions and the following disclaimer.
|
||||||
|
# 2. Redistributions in binary form must reproduce the above copyright
|
||||||
|
# notice, this list of conditions and the following disclaimer in
|
||||||
|
# the documentation and/or other materials provided with the
|
||||||
|
# distribution.
|
||||||
|
# 3. Neither the name NuttX nor the names of its contributors may be
|
||||||
|
# used to endorse or promote products derived from this software
|
||||||
|
# without specific prior written permission.
|
||||||
|
#
|
||||||
|
# THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
|
||||||
|
# "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
|
||||||
|
# LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
|
||||||
|
# FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE
|
||||||
|
# COPYRIGHT OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT,
|
||||||
|
# INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
|
||||||
|
# BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS
|
||||||
|
# OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED
|
||||||
|
# AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
|
||||||
|
# LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN
|
||||||
|
# ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
|
||||||
|
# POSSIBILITY OF SUCH DAMAGE.
|
||||||
|
#
|
||||||
|
############################################################################
|
||||||
|
|
||||||
|
-include $(TOPDIR)/Make.defs
|
||||||
|
|
||||||
|
# GPIO, World! built-in application info
|
||||||
|
|
||||||
|
CONFIG_EXAMPLES_GPIO_PRIORITY ?= SCHED_PRIORITY_DEFAULT
|
||||||
|
CONFIG_EXAMPLES_GPIO_STACKSIZE ?= 2048
|
||||||
|
|
||||||
|
APPNAME = gpio
|
||||||
|
PRIORITY = $(CONFIG_EXAMPLES_GPIO_PRIORITY)
|
||||||
|
STACKSIZE = $(CONFIG_EXAMPLES_GPIO_STACKSIZE)
|
||||||
|
|
||||||
|
# GPIO, World! Example
|
||||||
|
|
||||||
|
ASRCS =
|
||||||
|
CSRCS =
|
||||||
|
MAINSRC = gpio_main.c
|
||||||
|
|
||||||
|
CONFIG_EXAMPLES_GPIO_PROGNAME ?= gpio$(EXEEXT)
|
||||||
|
PROGNAME = $(CONFIG_EXAMPLES_GPIO_PROGNAME)
|
||||||
|
|
||||||
|
include $(APPDIR)/Application.mk
|
330
examples/gpio/gpio_main.c
Normal file
330
examples/gpio/gpio_main.c
Normal file
@ -0,0 +1,330 @@
|
|||||||
|
/****************************************************************************
|
||||||
|
* examples/gpio/gpio_main.c
|
||||||
|
*
|
||||||
|
* Copyright (C) 2016 Gregory Nutt. All rights reserved.
|
||||||
|
* Author: Gregory Nutt <gnutt@nuttx.org>
|
||||||
|
*
|
||||||
|
* Redistribution and use in source and binary forms, with or without
|
||||||
|
* modification, are permitted provided that the following conditions
|
||||||
|
* are met:
|
||||||
|
*
|
||||||
|
* 1. Redistributions of source code must retain the above copyright
|
||||||
|
* notice, this list of conditions and the following disclaimer.
|
||||||
|
* 2. Redistributions in binary form must reproduce the above copyright
|
||||||
|
* notice, this list of conditions and the following disclaimer in
|
||||||
|
* the documentation and/or other materials provided with the
|
||||||
|
* distribution.
|
||||||
|
* 3. Neither the name NuttX nor the names of its contributors may be
|
||||||
|
* used to endorse or promote products derived from this software
|
||||||
|
* without specific prior written permission.
|
||||||
|
*
|
||||||
|
* THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
|
||||||
|
* "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
|
||||||
|
* LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
|
||||||
|
* FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE
|
||||||
|
* COPYRIGHT OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT,
|
||||||
|
* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
|
||||||
|
* BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS
|
||||||
|
* OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED
|
||||||
|
* AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
|
||||||
|
* LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN
|
||||||
|
* ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
|
||||||
|
* POSSIBILITY OF SUCH DAMAGE.
|
||||||
|
*
|
||||||
|
****************************************************************************/
|
||||||
|
|
||||||
|
/****************************************************************************
|
||||||
|
* Included Files
|
||||||
|
****************************************************************************/
|
||||||
|
|
||||||
|
#include <nuttx/config.h>
|
||||||
|
|
||||||
|
#include <sys/ioctl.h>
|
||||||
|
#include <stdbool.h>
|
||||||
|
#include <stdlib.h>
|
||||||
|
#include <stdio.h>
|
||||||
|
#include <string.h>
|
||||||
|
#include <fcntl.h>
|
||||||
|
#include <signal.h>
|
||||||
|
#include <errno.h>
|
||||||
|
|
||||||
|
#include <nuttx/ioexpander/gpio.h>
|
||||||
|
|
||||||
|
/****************************************************************************
|
||||||
|
* Private Functions
|
||||||
|
****************************************************************************/
|
||||||
|
|
||||||
|
static void show_usage(FAR const char *progname)
|
||||||
|
{
|
||||||
|
fprintf(stderr, "USAGE: %s [-w <signo>] [-o <value>] <driver-path>\n");
|
||||||
|
fprintf(stderr, " %s -h\n");
|
||||||
|
fprintf(stderr, "Where:\n");
|
||||||
|
fprintf(stderr, "\t<driver-path>: The full path to the GPIO pin driver.\n");
|
||||||
|
fprintf(stderr, "\t-w <signo>: Wait for an signal if this is an interrupt pin.\n");
|
||||||
|
fprintf(stderr, "\t-o <value>: Write this value (0 or 1) if this is an output pin.\n");
|
||||||
|
fprintf(stderr, "\t-h: Print this usage information and exit.\n");
|
||||||
|
}
|
||||||
|
|
||||||
|
/****************************************************************************
|
||||||
|
* Public Functions
|
||||||
|
****************************************************************************/
|
||||||
|
|
||||||
|
/****************************************************************************
|
||||||
|
* gpio_main
|
||||||
|
****************************************************************************/
|
||||||
|
|
||||||
|
#ifdef CONFIG_BUILD_KERNEL
|
||||||
|
int main(int argc, FAR char *argv[])
|
||||||
|
#else
|
||||||
|
int gpio_main(int argc, char *argv[])
|
||||||
|
#endif
|
||||||
|
{
|
||||||
|
FAR char *devpath = NULL;
|
||||||
|
enum gpio_pintype_e pintype;
|
||||||
|
bool havesigno = false;
|
||||||
|
bool invalue;
|
||||||
|
bool outvalue = false;
|
||||||
|
bool haveout = false;
|
||||||
|
int signo = 0;
|
||||||
|
int ndx;
|
||||||
|
int ret;
|
||||||
|
int fd;
|
||||||
|
|
||||||
|
/* Parse command line */
|
||||||
|
|
||||||
|
if (argc < 2)
|
||||||
|
{
|
||||||
|
fprintf(stderr, "ERROR: Missing required arguments\n");
|
||||||
|
show_usage(argv[0]);
|
||||||
|
return EXIT_FAILURE;
|
||||||
|
}
|
||||||
|
|
||||||
|
ndx = 1;
|
||||||
|
if (strcmp(argv[ndx], "-h") == 0)
|
||||||
|
{
|
||||||
|
show_usage(argv[0]);
|
||||||
|
return EXIT_FAILURE;
|
||||||
|
}
|
||||||
|
|
||||||
|
if (strcmp(argv[ndx], "-w") == 0)
|
||||||
|
{
|
||||||
|
havesigno = true;
|
||||||
|
|
||||||
|
if (++ndx >= argc)
|
||||||
|
{
|
||||||
|
fprintf(stderr, "ERROR: Missing argument to -o\n");
|
||||||
|
show_usage(argv[0]);
|
||||||
|
return EXIT_FAILURE;
|
||||||
|
}
|
||||||
|
|
||||||
|
signo = atoi(argv[ndx]);
|
||||||
|
|
||||||
|
if (++ndx >= argc)
|
||||||
|
{
|
||||||
|
fprintf(stderr, "ERROR: Missing required <driver-path>\n");
|
||||||
|
show_usage(argv[0]);
|
||||||
|
return EXIT_FAILURE;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
if (ndx < argc && strcmp(argv[ndx], "-o"))
|
||||||
|
{
|
||||||
|
if (++ndx >= argc)
|
||||||
|
{
|
||||||
|
fprintf(stderr, "ERROR: Missing argument to -o\n");
|
||||||
|
show_usage(argv[0]);
|
||||||
|
return EXIT_FAILURE;
|
||||||
|
}
|
||||||
|
|
||||||
|
if (strcmp(argv[ndx], "0"))
|
||||||
|
{
|
||||||
|
outvalue = false;
|
||||||
|
haveout = true;
|
||||||
|
}
|
||||||
|
else if (strcmp(argv[ndx], "1"))
|
||||||
|
{
|
||||||
|
outvalue = true;
|
||||||
|
haveout = true;
|
||||||
|
}
|
||||||
|
else
|
||||||
|
{
|
||||||
|
fprintf(stderr, "ERROR: Invalid argument to -o\n");
|
||||||
|
show_usage(argv[0]);
|
||||||
|
return EXIT_FAILURE;
|
||||||
|
}
|
||||||
|
|
||||||
|
if (++ndx >= argc)
|
||||||
|
{
|
||||||
|
fprintf(stderr, "ERROR: Missing required <driver-path>\n");
|
||||||
|
show_usage(argv[0]);
|
||||||
|
return EXIT_FAILURE;
|
||||||
|
}
|
||||||
|
|
||||||
|
}
|
||||||
|
|
||||||
|
devpath = argv[ndx];
|
||||||
|
printf("Driver: %s\n", devpath);
|
||||||
|
|
||||||
|
/* Open the pin driver */
|
||||||
|
|
||||||
|
fd = open(devpath, O_RDWR);
|
||||||
|
if (fd < 0)
|
||||||
|
{
|
||||||
|
int errcode = errno;
|
||||||
|
fprintf(stderr, "ERROR: Failed to open %s: %d\n", devpath, errcode);
|
||||||
|
return EXIT_FAILURE;
|
||||||
|
}
|
||||||
|
|
||||||
|
/* Get the pin type */
|
||||||
|
|
||||||
|
ret = ioctl(fd, GPIOC_PINTYPE, (unsigned long)((uintptr_t)&pintype));
|
||||||
|
if (ret < 0)
|
||||||
|
{
|
||||||
|
int errcode = errno;
|
||||||
|
fprintf(stderr, "ERROR: Failed to read pintype from %s: %d\n", devpath, errcode);
|
||||||
|
close(fd);
|
||||||
|
return EXIT_FAILURE;
|
||||||
|
}
|
||||||
|
|
||||||
|
/* Read the pin value */
|
||||||
|
|
||||||
|
ret = ioctl(fd, GPIOC_READ, (unsigned long)((uintptr_t)&invalue));
|
||||||
|
if (ret < 0)
|
||||||
|
{
|
||||||
|
int errcode = errno;
|
||||||
|
fprintf(stderr, "ERROR: Failed to read value from %s: %d\n", devpath, errcode);
|
||||||
|
close(fd);
|
||||||
|
return EXIT_FAILURE;
|
||||||
|
}
|
||||||
|
|
||||||
|
/* Perform the test based on the pintype and on command line options */
|
||||||
|
|
||||||
|
switch (pintype)
|
||||||
|
{
|
||||||
|
case GPIO_INPUT_PIN:
|
||||||
|
{
|
||||||
|
printf(" Input pin: Value=%u\n", (unsigned int)invalue);
|
||||||
|
}
|
||||||
|
break;
|
||||||
|
|
||||||
|
case GPIO_OUTPUT_PIN:
|
||||||
|
{
|
||||||
|
printf(" Output pin: Value=%u\n", (unsigned int)invalue);
|
||||||
|
|
||||||
|
if (haveout)
|
||||||
|
{
|
||||||
|
printf(" Writing: Value=%u\n", (unsigned int)outvalue);
|
||||||
|
|
||||||
|
/* Write the pin value */
|
||||||
|
|
||||||
|
ret = ioctl(fd, GPIOC_WRITE, (unsigned long)outvalue);
|
||||||
|
if (ret < 0)
|
||||||
|
{
|
||||||
|
int errcode = errno;
|
||||||
|
fprintf(stderr, "ERROR: Failed to write value %u from %s: %d\n",
|
||||||
|
devpath, (unsigned int)outvalue, errcode);
|
||||||
|
close(fd);
|
||||||
|
return EXIT_FAILURE;
|
||||||
|
}
|
||||||
|
|
||||||
|
/* Re-read the pin value */
|
||||||
|
|
||||||
|
ret = ioctl(fd, GPIOC_READ, (unsigned long)((uintptr_t)&invalue));
|
||||||
|
if (ret < 0)
|
||||||
|
{
|
||||||
|
int errcode = errno;
|
||||||
|
fprintf(stderr, "ERROR: Failed to re-read value from %s: %d\n",
|
||||||
|
devpath, errcode);
|
||||||
|
close(fd);
|
||||||
|
return EXIT_FAILURE;
|
||||||
|
}
|
||||||
|
|
||||||
|
printf(" Verify: Value=%u\n", (unsigned int)invalue);
|
||||||
|
}
|
||||||
|
else
|
||||||
|
{
|
||||||
|
fprintf(stderr, "ERROR: Missing value to write\n");
|
||||||
|
show_usage(argv[0]);
|
||||||
|
close(fd);
|
||||||
|
return EXIT_FAILURE;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
break;
|
||||||
|
|
||||||
|
case GPIO_INTERRUPT_PIN:
|
||||||
|
{
|
||||||
|
printf(" Interrupt pin: Value=%u\n", invalue);
|
||||||
|
|
||||||
|
if (havesigno)
|
||||||
|
{
|
||||||
|
struct timespec ts;
|
||||||
|
struct siginfo info;
|
||||||
|
sigset_t set;
|
||||||
|
|
||||||
|
/* Set up to receive signal */
|
||||||
|
|
||||||
|
ret = ioctl(fd, GPIOC_REGISTER, (unsigned long)signo);
|
||||||
|
if (ret < 0)
|
||||||
|
{
|
||||||
|
int errcode = errno;
|
||||||
|
fprintf(stderr, "ERROR: Failed to setup for signal from %s: %d\n",
|
||||||
|
devpath, errcode);
|
||||||
|
close(fd);
|
||||||
|
return EXIT_FAILURE;
|
||||||
|
}
|
||||||
|
|
||||||
|
/* Wait up to 5 seconds for the signal */
|
||||||
|
|
||||||
|
(void)sigemptyset(&set);
|
||||||
|
(void)sigaddset(&set, signo);
|
||||||
|
|
||||||
|
ts.tv_sec = 5;
|
||||||
|
ts.tv_nsec = 0;
|
||||||
|
|
||||||
|
ret = sigtimedwait(&set, &info, &ts);
|
||||||
|
(void)ioctl(fd, GPIOC_UNREGISTER, 0);
|
||||||
|
|
||||||
|
if (ret < 0)
|
||||||
|
{
|
||||||
|
int errcode = errno;
|
||||||
|
if (errcode == EAGAIN)
|
||||||
|
{
|
||||||
|
printf(" [Five second timeout with no signal]\n");
|
||||||
|
close(fd);
|
||||||
|
return EXIT_SUCCESS;
|
||||||
|
}
|
||||||
|
else
|
||||||
|
{
|
||||||
|
fprintf(stderr, "ERROR: Failed to wait signal %d from %s: %d\n",
|
||||||
|
signo, devpath, errcode);
|
||||||
|
close(fd);
|
||||||
|
return EXIT_FAILURE;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
/* Re-read the pin value */
|
||||||
|
|
||||||
|
ret = ioctl(fd, GPIOC_READ, (unsigned long)((uintptr_t)&invalue));
|
||||||
|
if (ret < 0)
|
||||||
|
{
|
||||||
|
int errcode = errno;
|
||||||
|
fprintf(stderr, "ERROR: Failed to re-read value from %s: %d\n",
|
||||||
|
devpath, errcode);
|
||||||
|
close(fd);
|
||||||
|
return EXIT_FAILURE;
|
||||||
|
}
|
||||||
|
|
||||||
|
printf(" Verify: Value=%u\n", (unsigned int)invalue);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
break;
|
||||||
|
|
||||||
|
default:
|
||||||
|
fprintf(stderr, "ERROR: Unrecognized pintype: %d\n", (int)pintype);
|
||||||
|
close(fd);
|
||||||
|
return EXIT_FAILURE;
|
||||||
|
}
|
||||||
|
|
||||||
|
close(fd);
|
||||||
|
return EXIT_SUCCESS;
|
||||||
|
}
|
Loading…
Reference in New Issue
Block a user