first re-commit.
This commit is contained in:
417
pigpio-master/pigpiod.c
Normal file
417
pigpio-master/pigpiod.c
Normal file
@@ -0,0 +1,417 @@
|
||||
/*
|
||||
This is free and unencumbered software released into the public domain.
|
||||
|
||||
Anyone is free to copy, modify, publish, use, compile, sell, or
|
||||
distribute this software, either in source code form or as a compiled
|
||||
binary, for any purpose, commercial or non-commercial, and by any
|
||||
means.
|
||||
|
||||
In jurisdictions that recognize copyright laws, the author or authors
|
||||
of this software dedicate any and all copyright interest in the
|
||||
software to the public domain. We make this dedication for the benefit
|
||||
of the public at large and to the detriment of our heirs and
|
||||
successors. We intend this dedication to be an overt act of
|
||||
relinquishment in perpetuity of all present and future rights to this
|
||||
software under copyright law.
|
||||
|
||||
THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
|
||||
EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
|
||||
MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.
|
||||
IN NO EVENT SHALL THE AUTHORS BE LIABLE FOR ANY CLAIM, DAMAGES OR
|
||||
OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE,
|
||||
ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR
|
||||
OTHER DEALINGS IN THE SOFTWARE.
|
||||
|
||||
For more information, please refer to <http://unlicense.org/>
|
||||
*/
|
||||
|
||||
/*
|
||||
This version is for pigpio version 69+
|
||||
*/
|
||||
|
||||
#include <sys/types.h>
|
||||
#include <sys/stat.h>
|
||||
#include <pwd.h>
|
||||
#include <stdio.h>
|
||||
#include <stdlib.h>
|
||||
#include <stdarg.h>
|
||||
#include <fcntl.h>
|
||||
#include <errno.h>
|
||||
#include <unistd.h>
|
||||
#include <syslog.h>
|
||||
#include <string.h>
|
||||
#include <signal.h>
|
||||
#include <ctype.h>
|
||||
#include <sys/socket.h>
|
||||
#include <netdb.h>
|
||||
|
||||
#include "pigpio.h"
|
||||
|
||||
/*
|
||||
This program starts the pigpio library as a daemon.
|
||||
*/
|
||||
|
||||
static unsigned bufferSizeMilliseconds = PI_DEFAULT_BUFFER_MILLIS;
|
||||
static unsigned clockMicros = PI_DEFAULT_CLK_MICROS;
|
||||
static unsigned clockPeripheral = PI_DEFAULT_CLK_PERIPHERAL;
|
||||
static unsigned ifFlags = PI_DEFAULT_IF_FLAGS;
|
||||
static int foreground = PI_DEFAULT_FOREGROUND;
|
||||
static unsigned DMAprimaryChannel = PI_DEFAULT_DMA_NOT_SET;
|
||||
static unsigned DMAsecondaryChannel = PI_DEFAULT_DMA_NOT_SET;
|
||||
static unsigned socketPort = PI_DEFAULT_SOCKET_PORT;
|
||||
static unsigned memAllocMode = PI_DEFAULT_MEM_ALLOC_MODE;
|
||||
static uint64_t updateMask = -1;
|
||||
|
||||
static uint32_t cfgInternals = PI_DEFAULT_CFG_INTERNALS;
|
||||
|
||||
static int updateMaskSet = 0;
|
||||
|
||||
static FILE * errFifo;
|
||||
|
||||
static uint32_t sockNetAddr[MAX_CONNECT_ADDRESSES];
|
||||
|
||||
static int numSockNetAddr = 0;
|
||||
|
||||
void fatal(char *fmt, ...)
|
||||
{
|
||||
char buf[128];
|
||||
va_list ap;
|
||||
|
||||
va_start(ap, fmt);
|
||||
vsnprintf(buf, sizeof(buf), fmt, ap);
|
||||
va_end(ap);
|
||||
|
||||
fprintf(stderr, "%s\n", buf);
|
||||
|
||||
fflush(stderr);
|
||||
|
||||
exit(EXIT_FAILURE);
|
||||
}
|
||||
|
||||
void usage()
|
||||
{
|
||||
fprintf(stderr, "\n" \
|
||||
"pigpio V%d\n" \
|
||||
"Usage: sudo pigpiod [OPTION] ...\n" \
|
||||
" -a value, DMA mode, 0=AUTO, 1=PMAP, 2=MBOX, default AUTO\n" \
|
||||
" -b value, sample buffer size in ms, default 120\n" \
|
||||
" -c value, library internal settings, default 0\n" \
|
||||
" -d value, primary DMA channel, 0-14, default 14\n" \
|
||||
" -e value, secondary DMA channel, 0-14, default 6\n" \
|
||||
" -f, disable fifo interface, default enabled\n" \
|
||||
" -g, run in foreground (do not fork), default disabled\n" \
|
||||
" -k, disable socket interface, default enabled\n" \
|
||||
" -l, localhost socket only default local+remote\n" \
|
||||
" -m, disable alerts default enabled\n" \
|
||||
" -n IP addr, allow address, name or dotted, default allow all\n" \
|
||||
" -p value, socket port, 1024-32000, default 8888\n" \
|
||||
" -s value, sample rate, 1, 2, 4, 5, 8, or 10, default 5\n" \
|
||||
" -t value, clock peripheral, 0=PWM 1=PCM, default PCM\n" \
|
||||
" -v, -V, display pigpio version and exit\n" \
|
||||
" -x mask, GPIO which may be updated, default board GPIO\n" \
|
||||
"EXAMPLE\n" \
|
||||
"sudo pigpiod -s 2 -b 200 -f\n" \
|
||||
" Set a sample rate of 2 microseconds with a 200 millisecond\n" \
|
||||
" buffer. Disable the fifo interface.\n" \
|
||||
"\n", PIGPIO_VERSION);
|
||||
}
|
||||
|
||||
static uint64_t getNum(char *str, int *err)
|
||||
{
|
||||
uint64_t val;
|
||||
char *endptr;
|
||||
|
||||
*err = 0;
|
||||
val = strtoll(str, &endptr, 0);
|
||||
if (*endptr) {*err = 1; val = -1;}
|
||||
return val;
|
||||
}
|
||||
|
||||
static uint32_t checkAddr(char *addrStr)
|
||||
{
|
||||
int err;
|
||||
struct addrinfo hints, *res;
|
||||
struct sockaddr_in *sin;
|
||||
const char *portStr;
|
||||
uint32_t addr;
|
||||
|
||||
portStr = getenv(PI_ENVPORT);
|
||||
|
||||
if (!portStr) portStr = PI_DEFAULT_SOCKET_PORT_STR;
|
||||
|
||||
memset (&hints, 0, sizeof (hints));
|
||||
|
||||
hints.ai_family = AF_INET;
|
||||
hints.ai_socktype = SOCK_STREAM;
|
||||
hints.ai_flags |= AI_CANONNAME;
|
||||
|
||||
err = getaddrinfo(addrStr, portStr, &hints, &res);
|
||||
|
||||
if (err) return 0;
|
||||
|
||||
sin = (struct sockaddr_in *)res->ai_addr;
|
||||
addr = sin->sin_addr.s_addr;
|
||||
|
||||
freeaddrinfo(res);
|
||||
|
||||
return addr;
|
||||
}
|
||||
|
||||
static void initOpts(int argc, char *argv[])
|
||||
{
|
||||
int opt, err, i;
|
||||
uint32_t addr;
|
||||
int64_t mask;
|
||||
|
||||
while ((opt = getopt(argc, argv, "a:b:c:d:e:fgkln:mp:s:t:x:vV")) != -1)
|
||||
{
|
||||
switch (opt)
|
||||
{
|
||||
case 'a':
|
||||
i = getNum(optarg, &err);
|
||||
if ((i >= PI_MEM_ALLOC_AUTO) && (i <= PI_MEM_ALLOC_MAILBOX))
|
||||
memAllocMode = i;
|
||||
else fatal("invalid -a option (%d)", i);
|
||||
break;
|
||||
|
||||
case 'b':
|
||||
i = getNum(optarg, &err);
|
||||
if ((i >= PI_BUF_MILLIS_MIN) && (i <= PI_BUF_MILLIS_MAX))
|
||||
bufferSizeMilliseconds = i;
|
||||
else fatal("invalid -b option (%d)", i);
|
||||
break;
|
||||
|
||||
case 'c':
|
||||
i = getNum(optarg, &err);
|
||||
if ((i >= 0) && (i < PI_CFG_ILLEGAL_VAL))
|
||||
cfgInternals = i;
|
||||
else fatal("invalid -c option (%x)", i);
|
||||
break;
|
||||
|
||||
case 'd':
|
||||
i = getNum(optarg, &err);
|
||||
if ((i >= PI_MIN_DMA_CHANNEL) && (i <= PI_MAX_DMA_CHANNEL))
|
||||
DMAprimaryChannel = i;
|
||||
else fatal("invalid -d option (%d)", i);
|
||||
break;
|
||||
|
||||
case 'e':
|
||||
i = getNum(optarg, &err);
|
||||
if ((i >= PI_MIN_DMA_CHANNEL) && (i <= PI_MAX_DMA_CHANNEL))
|
||||
DMAsecondaryChannel = i;
|
||||
else fatal("invalid -e option (%d)", i);
|
||||
break;
|
||||
|
||||
case 'f':
|
||||
ifFlags |= PI_DISABLE_FIFO_IF;
|
||||
break;
|
||||
|
||||
case 'g':
|
||||
foreground = 1;
|
||||
break;
|
||||
|
||||
case 'k':
|
||||
ifFlags |= PI_DISABLE_SOCK_IF;
|
||||
break;
|
||||
|
||||
case 'l':
|
||||
ifFlags |= PI_LOCALHOST_SOCK_IF;
|
||||
break;
|
||||
|
||||
case 'm':
|
||||
ifFlags |= PI_DISABLE_ALERT;
|
||||
break;
|
||||
|
||||
case 'n':
|
||||
addr = checkAddr(optarg);
|
||||
if (addr && (numSockNetAddr<MAX_CONNECT_ADDRESSES))
|
||||
sockNetAddr[numSockNetAddr++] = addr;
|
||||
else fatal("invalid -n option (%s)", optarg);
|
||||
break;
|
||||
|
||||
case 'p':
|
||||
i = getNum(optarg, &err);
|
||||
if ((i >= PI_MIN_SOCKET_PORT) && (i <= PI_MAX_SOCKET_PORT))
|
||||
socketPort = i;
|
||||
else fatal("invalid -p option (%d)", i);
|
||||
break;
|
||||
|
||||
case 's':
|
||||
i = getNum(optarg, &err);
|
||||
|
||||
switch(i)
|
||||
{
|
||||
case 1:
|
||||
case 2:
|
||||
case 4:
|
||||
case 5:
|
||||
case 8:
|
||||
case 10:
|
||||
clockMicros = i;
|
||||
break;
|
||||
|
||||
default:
|
||||
fatal("invalid -s option (%d)", i);
|
||||
break;
|
||||
}
|
||||
break;
|
||||
|
||||
case 't':
|
||||
i = getNum(optarg, &err);
|
||||
if ((i >= PI_CLOCK_PWM) && (i <= PI_CLOCK_PCM))
|
||||
clockPeripheral = i;
|
||||
else fatal("invalid -t option (%d)", i);
|
||||
break;
|
||||
|
||||
case 'v':
|
||||
case 'V':
|
||||
printf("%d\n", PIGPIO_VERSION);
|
||||
exit(EXIT_SUCCESS);
|
||||
break;
|
||||
|
||||
case 'x':
|
||||
mask = getNum(optarg, &err);
|
||||
if (!err)
|
||||
{
|
||||
updateMask = mask;
|
||||
updateMaskSet = 1;
|
||||
}
|
||||
else fatal("invalid -x option (%s)", optarg);
|
||||
break;
|
||||
|
||||
default: /* '?' */
|
||||
usage();
|
||||
exit(EXIT_FAILURE);
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
void terminate(int signum)
|
||||
{
|
||||
/* only registered for SIGHUP/SIGTERM */
|
||||
|
||||
gpioTerminate();
|
||||
|
||||
fprintf(errFifo, "SIGHUP/SIGTERM received\n");
|
||||
|
||||
fflush(NULL);
|
||||
|
||||
fclose(errFifo);
|
||||
|
||||
unlink(PI_ERRFIFO);
|
||||
|
||||
exit(0);
|
||||
}
|
||||
|
||||
|
||||
int main(int argc, char **argv)
|
||||
{
|
||||
pid_t pid;
|
||||
int flags;
|
||||
|
||||
/* check command line parameters */
|
||||
|
||||
initOpts(argc, argv);
|
||||
|
||||
if (!foreground) {
|
||||
/* Fork off the parent process */
|
||||
|
||||
pid = fork();
|
||||
|
||||
if (pid < 0) { exit(EXIT_FAILURE); }
|
||||
|
||||
/* If we got a good PID, then we can exit the parent process. */
|
||||
|
||||
if (pid > 0) { exit(EXIT_SUCCESS); }
|
||||
|
||||
/* Change the file mode mask */
|
||||
|
||||
umask(0);
|
||||
|
||||
/* Open any logs here */
|
||||
|
||||
/* NONE */
|
||||
|
||||
/* Create a new SID for the child process */
|
||||
|
||||
if (setsid() < 0) fatal("setsid failed (%m)");
|
||||
|
||||
/* Change the current working directory */
|
||||
|
||||
if ((chdir("/")) < 0) fatal("chdir failed (%m)");
|
||||
|
||||
/* Close out the standard file descriptors */
|
||||
|
||||
fclose(stdin);
|
||||
fclose(stdout);
|
||||
}
|
||||
|
||||
/* configure library */
|
||||
|
||||
gpioCfgBufferSize(bufferSizeMilliseconds);
|
||||
|
||||
gpioCfgClock(clockMicros, clockPeripheral, 0);
|
||||
|
||||
gpioCfgInterfaces(ifFlags);
|
||||
|
||||
gpioCfgDMAchannels(DMAprimaryChannel, DMAsecondaryChannel);
|
||||
|
||||
gpioCfgSocketPort(socketPort);
|
||||
|
||||
gpioCfgMemAlloc(memAllocMode);
|
||||
|
||||
if (updateMaskSet) gpioCfgPermissions(updateMask);
|
||||
|
||||
gpioCfgNetAddr(numSockNetAddr, sockNetAddr);
|
||||
|
||||
gpioCfgSetInternals(cfgInternals);
|
||||
|
||||
/* start library */
|
||||
|
||||
if (gpioInitialise()< 0) fatal("Can't initialise pigpio library");
|
||||
|
||||
/* create pipe for error reporting */
|
||||
|
||||
unlink(PI_ERRFIFO);
|
||||
|
||||
mkfifo(PI_ERRFIFO, 0664);
|
||||
|
||||
if (chmod(PI_ERRFIFO, 0664) < 0)
|
||||
fatal("chmod %s failed (%m)", PI_ERRFIFO);
|
||||
|
||||
errFifo = freopen(PI_ERRFIFO, "w+", stderr);
|
||||
|
||||
if (errFifo)
|
||||
{
|
||||
/* set stderr non-blocking */
|
||||
|
||||
flags = fcntl(fileno(errFifo), F_GETFL, 0);
|
||||
fcntl(fileno(errFifo), F_SETFL, flags | O_NONBLOCK);
|
||||
|
||||
/* request SIGHUP/SIGTERM from libarary for termination */
|
||||
|
||||
gpioSetSignalFunc(SIGHUP, terminate);
|
||||
gpioSetSignalFunc(SIGTERM, terminate);
|
||||
|
||||
/* sleep forever */
|
||||
|
||||
while (1)
|
||||
{
|
||||
/* cat /dev/pigerr to view daemon errors */
|
||||
|
||||
sleep(5);
|
||||
|
||||
fflush(errFifo);
|
||||
}
|
||||
}
|
||||
else
|
||||
{
|
||||
fprintf(stderr, "freopen failed (%m)");
|
||||
|
||||
gpioTerminate();
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
|
||||
Reference in New Issue
Block a user