0

2025-01-27 22:06:00 +03:00
parent 5f404a6291
commit 19f61697d6
19 changed files with 906 additions and 0 deletions
--- a/LibSidServo/examples/CMakeLists.txt
+++ b/LibSidServo/examples/CMakeLists.txt
@@ -0,0 +1,8 @@
+project(examples)
+
+# common includes & library
+include_directories(../)
+link_libraries(sidservo usefull_macros)
+
+# exe list
+add_executable(dumpmoving dumpmoving.c)
--- a/LibSidServo/examples/dumpmoving.c
+++ b/LibSidServo/examples/dumpmoving.c
@@ -0,0 +1,84 @@
+/*
+ * This file is part of the libsidservo project.
+ * Copyright 2025 Edward V. Emelianov <edward.emelianoff@gmail.com>.
+ *
+ * This program is free software: you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License as published by
+ * the Free Software Foundation, either version 3 of the License, or
+ * (at your option) any later version.
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ * GNU General Public License for more details.
+ *
+ * You should have received a copy of the GNU General Public License
+ * along with this program.  If not, see <http://www.gnu.org/licenses/>.
+ */
+
+#include <signal.h>
+#include <stdio.h>
+#include <time.h>
+#include <usefull_macros.h>
+
+#include "sidservo.h"
+
+typedef struct{
+    int help;
+    int confhelp;
+    int verbose;
+    char *logfile;
+    char *conffile;
+    char *coordsoutput;
+} parameters;
+
+static parameters G = {0};
+
+static sl_option_t cmdlnopts[] = {
+    {"help",        NO_ARGS,    NULL,   'h',    arg_int,    APTR(&G.help),      "show this help"},
+    {"confhelp",    NO_ARGS,    NULL,   0,      arg_int,    APTR(&G.confhelp),  "show configuration file help"},
+    {"verbose",     NO_ARGS,    NULL,   'v',    arg_none,   APTR(&G.verbose),   "verbose level (each -v adds 1)"},
+    {"logfile",     NEED_ARG,   NULL,   'l',    arg_string, APTR(&G.logfile),   "log file name"},
+    {"conffile",    NEED_ARG,   NULL,   'c',    arg_string, APTR(&G.conffile),  "configuration file name"},
+    {"coordsfile",  NEED_ARG,   NULL,   'o',    arg_string, APTR(&G.coordsoutput),"output file with coordinates log"},
+    end_option
+};
+
+void signals(int sig){
+    if(sig){
+        signal(sig, SIG_IGN);
+        DBG("Get signal %d, quit.\n", sig);
+    }
+    LOGERR("Exit with status %d", sig);
+    Mount.quit();
+    exit(sig);
+}
+
+
+int main(int argc, char **argv){
+    sl_init();
+    sl_parseargs(&argc, &argv, cmdlnopts);
+    if(G.help) sl_showhelp(-1, cmdlnopts);
+    if(G.confhelp) Mount.helpandquit();
+    if(!G.conffile) ERRX("Point configuration file name");
+    sl_loglevel_e lvl = G.verbose + LOGLEVEL_ERR;
+    if(lvl >= LOGLEVEL_AMOUNT) lvl = LOGLEVEL_AMOUNT - 1;
+    if(G.logfile) OPENLOG(G.logfile, lvl, 1);
+    time_t curtime = time(NULL);
+    LOGMSG("Started @ %s", ctime(&curtime));
+    if(Mount.readconf(G.conffile) < 0) ERRX("Can't read configuration file %s", G.conffile);
+    green("Got config:\n");
+    Mount.dumpconf();
+    if(!Mount.init()) ERRX("Can't init");
+    DBG("Devices ready");
+    LOGMSG("Mount device %s @ %d", Conf.MountPath, Conf.MountSpeed);
+    LOGMSG("Encoder device %s @ %d", Conf.EncoderPath, Conf.EncoderSpeed);
+    signal(SIGTERM, signals); // kill (-15) - quit
+    signal(SIGHUP, SIG_IGN);  // hup - ignore
+    signal(SIGINT, signals);  // ctrl+C - quit
+    signal(SIGQUIT, signals); // ctrl+\ - quit
+    signal(SIGTSTP, SIG_IGN); // ignore ctrl+Z
+    ;;;
+    Mount.quit();
+    return 0;
+}