diff -r 251e1e0d272c -r d30959d74f54 xmldaemon/main.cpp --- a/xmldaemon/main.cpp Thu May 29 08:22:27 2008 +0000 +++ /dev/null Thu Jan 01 00:00:00 1970 +0000 @@ -1,312 +0,0 @@ -/****************************************************************************** - * - * $Id$ - * - * Copyright (C) 2006 Florian Pose, Ingenieurgemeinschaft IgH - * - * This file is part of the IgH EtherCAT Master. - * - * The IgH EtherCAT Master 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 2 of the - * License, or (at your option) any later version. - * - * The IgH EtherCAT Master 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 the IgH EtherCAT Master; if not, write to the Free Software - * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA - * - * The right to use EtherCAT Technology is granted and comes free of - * charge under condition of compatibility of product made by - * Licensee. People intending to distribute/sell products based on the - * code, have to sign an agreement to guarantee that products using - * software based on IgH EtherCAT master stay compatible with the actual - * EtherCAT specification (which are released themselves as an open - * standard) as the (only) precondition to have the right to use EtherCAT - * Technology, IP and trade marks. - * - *****************************************************************************/ - -/** - \file - EtherCAT XML Daemon. -*/ - -/*****************************************************************************/ - -#include -#include -#include -#include - -#include - -#include -#include -using namespace std; - -#include "slave_device.hpp" - -/*****************************************************************************/ - -unsigned int sig_int_term = 0; -unsigned int sig_hangup = 0; -string xml_dir; -bool become_daemon = true; - -list slaveDevices; - -/*****************************************************************************/ - -void parse_xml_file(const char *); -void parse_info(xmlDocPtr, xmlNodePtr); -void parse_descriptions(xmlDocPtr, xmlNodePtr); -void parse_devices(xmlDocPtr, xmlNodePtr); - -void read_xml_dir(); -void set_signal_handlers(); -void get_options(int, char *[]); -void print_usage(); -void signal_handler(int); -void init_daemon(); - -/*****************************************************************************/ - -int main(int argc, char *argv[]) -{ - set_signal_handlers(); - get_options(argc, argv); - - read_xml_dir(); - - if (become_daemon) init_daemon(); - - openlog("ecxmld", LOG_PID, LOG_DAEMON); - syslog(LOG_INFO, "EtherCAT XML daemon starting up."); - - return 0; -} - -/*****************************************************************************/ - -void read_xml_dir() -{ - DIR *dir; - struct dirent *dir_ent; - string entry; - - if (!(dir = opendir(xml_dir.c_str()))) { - cerr << "ERROR: Failed to open XML directory \"" << xml_dir << "\"!" - << endl; - exit(1); - } - - while ((dir_ent = readdir(dir))) { - entry = dir_ent->d_name; - if (entry.size() < 4 - || entry.substr(entry.size() - 4) != ".xml") continue; - - parse_xml_file((xml_dir + "/" + entry).c_str()); - } - - // Verzeichnis schliessen - closedir(dir); -} - -/*****************************************************************************/ - -void parse_xml_file(const char *xml_file) -{ - xmlDocPtr doc; - xmlNodePtr cur; - - cout << xml_file << endl; - - if (!(doc = xmlParseFile(xml_file))) { - cerr << "ERROR: Parse error in document!" << endl; - return; - } - - if (!(cur = xmlDocGetRootElement(doc))) { - cout << "Empty document!" << endl; - xmlFreeDoc(doc); - return; - } - - if (xmlStrcmp(cur->name, (const xmlChar *) "EtherCATInfo")) { - cerr << "Document of the wrong type!" << endl; - xmlFreeDoc(doc); - return; - } - - parse_info(doc, cur); - xmlFreeDoc(doc); -} - -/*****************************************************************************/ - -void parse_info(xmlDocPtr doc, xmlNodePtr cur) -{ - cout << "info" << endl; - cur = cur->xmlChildrenNode; - - while (cur) { - if ((!xmlStrcmp(cur->name, (const xmlChar *) "Descriptions"))) { - parse_descriptions(doc, cur); - } - cur = cur->next; - } -} - -/*****************************************************************************/ - -void parse_descriptions(xmlDocPtr doc, xmlNodePtr cur) -{ - cout << "desc" << endl; - cur = cur->xmlChildrenNode; - - while (cur) { - if ((!xmlStrcmp(cur->name, (const xmlChar *) "Devices"))) { - parse_devices(doc, cur); - } - cur = cur->next; - } -} - -/*****************************************************************************/ - -void parse_devices(xmlDocPtr doc, xmlNodePtr cur) -{ - cout << "devices" << endl; - cur = cur->xmlChildrenNode; - - while (cur) { - if ((!xmlStrcmp(cur->name, (const xmlChar *) "Device"))) { - slaveDevices.push_back(SlaveDevice()); - slaveDevices.back().fromXml(doc, cur); - } - cur = cur->next; - } -} - -/*****************************************************************************/ - -void get_options(int argc, char *argv[]) -{ - int c; - - while (1) { - if ((c = getopt(argc, argv, "d:kh")) == -1) break; - - switch (c) { - case 'd': - xml_dir = optarg; - break; - - case 'k': - become_daemon = false; - break; - - case 'h': - print_usage(); - exit(0); - - default: - print_usage(); - exit(1); - } - } - - if (optind < argc) { - cerr << "ERROR: Too many arguments!" << endl; - print_usage(); - exit(1); - } - - if (xml_dir == "") { - cerr << "ERROR: XML directory not set!" << endl; - print_usage(); - exit(1); - } -} - -/*****************************************************************************/ - -void print_usage() -{ - cout << "Usage: ecxmld [OPTIONS]" << endl - << " -d DIR Set XML directory (MANDATORY)." << endl - << " -k Do not detach from console." << endl - << " -h Show this help." << endl; -} - -/*****************************************************************************/ - -void signal_handler(int sig) -{ - if (sig == SIGHUP) { - sig_hangup++; - } - else if (sig == SIGINT || sig == SIGTERM) { - sig_int_term++; - } -} - -/*****************************************************************************/ - -void set_signal_handlers() -{ - struct sigaction action; - - action.sa_handler = signal_handler; - sigemptyset(&action.sa_mask); - action.sa_flags = 0; - - sigaction(SIGHUP, &action, 0); - sigaction(SIGINT, &action, 0); - sigaction(SIGTERM, &action, 0); -} - -/*****************************************************************************/ - -void init_daemon() -{ - pid_t pid; - - if ((pid = fork()) < 0) { - cerr << endl << "ERROR: fork() failed!" << endl << endl; - exit(1); - } - - if (pid) exit(0); - - if (setsid() == -1) { - cerr << "ERROR: Failed to become session leader!" << endl; - exit(1); - } - - if (chdir("/") < 0) { - cerr << "ERROR: Failed to change to file root!" << endl; - exit(1); - } - - umask(0); - - if (close(0) < 0) { - cerr << "WARNING: Failed to close STDIN!" << endl; - } - - if (close(1) < 0) { - cerr << "WARNING: Failed to close STDOUT!" << endl; - } - - if (close(2) < 0) { - cerr << "WARNING: Failed to close STDERR!" << endl; - } -} - -/*****************************************************************************/