|
|
| version 1.2.2.8, 2012/05/22 14:15:04 | version 1.4.4.2, 2013/01/18 10:32:17 |
|---|---|
| Line 1 | Line 1 |
| /************************************************************************* | |
| * (C) 2011 AITNET ltd - Sofia/Bulgaria - <misho@aitbg.com> | |
| * by Michael Pounov <misho@openbsd-bg.org> | |
| * | |
| * $Author$ | |
| * $Id$ | |
| * | |
| ************************************************************************** | |
| The ELWIX and AITNET software is distributed under the following | |
| terms: | |
| All of the documentation and software included in the ELWIX and AITNET | |
| Releases is copyrighted by ELWIX - Sofia/Bulgaria <info@elwix.org> | |
| Copyright 2004, 2005, 2006, 2007, 2008, 2009, 2010, 2011, 2012, 2013 | |
| by Michael Pounov <misho@elwix.org>. All rights reserved. | |
| 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. All advertising materials mentioning features or use of this software | |
| must display the following acknowledgement: | |
| This product includes software developed by Michael Pounov <misho@elwix.org> | |
| ELWIX - Embedded LightWeight unIX and its contributors. | |
| 4. Neither the name of AITNET 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 AITNET 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 REGENTS 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 "global.h" | #include "global.h" |
| #include "rtlm.h" | #include "rtlm.h" |
| #include "mqtt.h" | #include "mqtt.h" |
| #include "client.h" | #include "client.h" |
| io_enableDEBUG; | |
| extern char compiled[], compiledby[], compilehost[]; | extern char compiled[], compiledby[], compilehost[]; |
| volatile intptr_t Kill; | volatile intptr_t Kill; |
| sched_root_task_t *root; | |
| struct tagArgs *args; | struct tagArgs *args; |
| Line 56 Subscribe(int sock, FILE *lf) | Line 100 Subscribe(int sock, FILE *lf) |
| u_short mid; | u_short mid; |
| mqtt_subscr_t *sub; | mqtt_subscr_t *sub; |
| #ifdef __NetBSD__ | |
| srandom(getpid() ^ time(NULL)); | |
| #else | |
| srandomdev(); | srandomdev(); |
| #endif | |
| mid = random() % USHRT_MAX; | mid = random() % USHRT_MAX; |
| printf(" > Execute SUBSCRIBE request #%d ... ", mid); | printf(" > Execute SUBSCRIBE request #%d ... ", mid); |
| Line 68 Subscribe(int sock, FILE *lf) | Line 116 Subscribe(int sock, FILE *lf) |
| printf("OK\n"); | printf("OK\n"); |
| for (sub = args->subscr, qos = qoses; sub->sub_topic.msg_base; sub++, qos++) | for (sub = args->subscr, qos = qoses; sub->sub_topic.msg_base; sub++, qos++) |
| printf(" + Topic %s with QoS %d subscribed %s\n", (char*) | printf(" + Topic %s with QoS %d subscribe %s\n", (char*) |
| sub->sub_topic.msg_base, sub->sub_ret, *qos ? "done" : "failed"); | sub->sub_topic.msg_base, sub->sub_ret, *qos ? "done" : "failed"); |
| free(qoses); | free(qoses); |
| Line 80 Unsubscribe(int sock) | Line 128 Unsubscribe(int sock) |
| { | { |
| u_short mid; | u_short mid; |
| #ifdef __NetBSD__ | |
| srandom(getpid() ^ time(NULL)); | |
| #else | |
| srandomdev(); | srandomdev(); |
| #endif | |
| mid = random() % USHRT_MAX; | mid = random() % USHRT_MAX; |
| printf(" > Execute UNSUBSCRIBE request #%d ... ", mid); | printf(" > Execute UNSUBSCRIBE request #%d ... ", mid); |
| Line 93 Unsubscribe(int sock) | Line 145 Unsubscribe(int sock) |
| return 0; | return 0; |
| } | } |
| static void | |
| sigz(int sig) | |
| { | |
| int stat; | |
| switch (sig) { | |
| case SIGINT: | |
| case SIGTERM: | |
| Kill++; | |
| break; | |
| case SIGCHLD: | |
| while (waitpid(-1, &stat, WNOHANG) > 0); | |
| break; | |
| } | |
| } | |
| static void * | |
| execProc(sched_task_t *task) | |
| { | |
| FILE *f; | |
| char szLine[MAXPATHLEN + BUFSIZ] = { 0 }; | |
| snprintf(szLine, sizeof szLine, "%s '%s' %hu %u", AIT_GET_STR(&args->Value), | |
| (char*) TASK_ARG(task), (u_short) TASK_VAL(task), (u_int) TASK_DATLEN(task)); | |
| if (TASK_ARG(task)) | |
| e_free(TASK_ARG(task)); | |
| f = popen(szLine, "w"); | |
| if (!f) { | |
| ESYSERR(0); | |
| return NULL; | |
| } else | |
| fputs(TASK_DATA(task), f); | |
| pclose(f); | |
| return NULL; | |
| } | |
| static void * | |
| pubRX(sched_task_t *task) | |
| { | |
| int siz, rlen; | |
| char szTime[STRSIZ] = { 0 }, szTopic[STRSIZ] = { 0 }; | |
| void *data = NULL; | |
| u_short mid; | |
| time_t tim; | |
| struct mqtthdr *hdr; | |
| rlen = RecvFrom(TASK_FD(task)); | |
| if (rlen == -1) | |
| goto end; | |
| if (!rlen) { | |
| Kill++; | |
| return NULL; | |
| } | |
| while (rlen > 0) { | |
| hdr = (struct mqtthdr*) args->msg->msg_base; | |
| switch (hdr->mqtt_msg.type) { | |
| case MQTT_TYPE_PUBLISH: | |
| siz = mqtt_readPUBLISH(args->msg, szTopic, sizeof szTopic, &mid, &data); | |
| if (siz == -1) | |
| goto end; | |
| else { | |
| siz = mqtt_pktLen(hdr); | |
| rlen -= siz; | |
| EVERBS(4) printf("Remains %d bytes, packet %d bytes\n", rlen, siz); | |
| } | |
| /* send to output */ | |
| tim = time(NULL); | |
| strftime(szTime, sizeof szTime, "%Y-%m-%d %H:%M:%S", localtime(&tim)); | |
| fprintf(TASK_ARG(task), "\n[%s] Message ID: %04hu, QoS: %hhu, " | |
| "Length: %u, Topic: %s\n", szTime, mid, hdr->mqtt_msg.qos, | |
| siz, szTopic); | |
| if (data) { | |
| fputs((const char*) data, TASK_ARG(task)); | |
| free(data); | |
| } | |
| fprintf(TASK_ARG(task), "\n"); | |
| fflush(TASK_ARG(task)); | |
| /* if exists exec script */ | |
| if (!AIT_ISEMPTY(&args->Value)) | |
| schedEvent(root, execProc, e_strdup(szTopic), mid, data, siz); | |
| memmove(args->msg->msg_base, args->msg->msg_base + siz, rlen); | |
| break; | |
| case MQTT_TYPE_PINGREQ: | |
| siz = mqtt_msgPINGRESP(args->msg); | |
| if (siz == -1) | |
| goto end; | |
| else | |
| rlen -= siz; | |
| /* send ping reply */ | |
| if (SendTo(TASK_FD(task), siz) == -1) | |
| goto end; | |
| memmove(args->msg->msg_base, args->msg->msg_base + siz, rlen); | |
| break; | |
| default: | |
| EVERBS(1) printf("Unwanted message type #%d ...\n", hdr->mqtt_msg.type); | |
| goto end; | |
| } | |
| } | |
| end: | |
| schedReadSelf(task); | |
| return NULL; | |
| } | |
| int | int |
| main(int argc, char **argv) | main(int argc, char **argv) |
| { | { |
| Line 104 main(int argc, char **argv) | Line 270 main(int argc, char **argv) |
| int ret = 0; | int ret = 0; |
| char *str, szStr[STRSIZ], szLogName[MAXPATHLEN] = { 0 }; | char *str, szStr[STRSIZ], szLogName[MAXPATHLEN] = { 0 }; |
| FILE *lf; | FILE *lf; |
| struct sigaction sa; | |
| if (!(args = malloc(sizeof(struct tagArgs)))) { | if (!(args = e_malloc(sizeof(struct tagArgs)))) { |
| printf("Error:: in arguments #%d - %s\n", errno, strerror(errno)); | printf("Error:: in arguments #%d - %s\n", errno, strerror(errno)); |
| return 1; | return 1; |
| } else | } else |
| memset(args, 0, sizeof(struct tagArgs)); | memset(args, 0, sizeof(struct tagArgs)); |
| if (!(args->subscr = mqtt_subAlloc(idx))) { | if (!(args->subscr = mqtt_subAlloc(idx))) { |
| printf("Error:: in subscribes array #%d - %s\n", mqtt_GetErrno(), mqtt_GetError()); | printf("Error:: in subscribes array #%d - %s\n", mqtt_GetErrno(), mqtt_GetError()); |
| free(args); | e_free(args); |
| return 1; | return 1; |
| } else | } else |
| args->free = cleanArgs; | args->free = cleanArgs; |
| Line 120 main(int argc, char **argv) | Line 287 main(int argc, char **argv) |
| if (!(args->msg = mqtt_msgAlloc(USHRT_MAX))) { | if (!(args->msg = mqtt_msgAlloc(USHRT_MAX))) { |
| printf("Error:: in mqtt buffer #%d - %s\n", mqtt_GetErrno(), mqtt_GetError()); | printf("Error:: in mqtt buffer #%d - %s\n", mqtt_GetErrno(), mqtt_GetError()); |
| args->free(args); | args->free(args); |
| free(args); | e_free(args); |
| return 1; | return 1; |
| } | } |
| Line 158 main(int argc, char **argv) | Line 325 main(int argc, char **argv) |
| if (!sub) { | if (!sub) { |
| printf("Error:: #%d - %s\n", mqtt_GetErrno(), mqtt_GetError()); | printf("Error:: #%d - %s\n", mqtt_GetErrno(), mqtt_GetError()); |
| args->free(args); | args->free(args); |
| free(args); | e_free(args); |
| return 1; | return 1; |
| } else | } else |
| sub += idx++; | sub += idx++; |
| Line 181 main(int argc, char **argv) | Line 348 main(int argc, char **argv) |
| if (args->QoS > MQTT_QOS_EXACTLY) { | if (args->QoS > MQTT_QOS_EXACTLY) { |
| printf("Error:: invalid QoS level %d\n", args->QoS); | printf("Error:: invalid QoS level %d\n", args->QoS); |
| args->free(args); | args->free(args); |
| free(args); | e_free(args); |
| return 1; | return 1; |
| } | } |
| break; | break; |
| Line 198 main(int argc, char **argv) | Line 365 main(int argc, char **argv) |
| batch = 0; | batch = 0; |
| break; | break; |
| case 'v': | case 'v': |
| io_incDebug; | e_incVerbose; |
| break; | break; |
| case 'u': | case 'u': |
| un = 1; | un = 1; |
| Line 206 main(int argc, char **argv) | Line 373 main(int argc, char **argv) |
| case 'h': | case 'h': |
| default: | default: |
| args->free(args); | args->free(args); |
| free(args); | e_free(args); |
| Usage(); | Usage(); |
| return 1; | return 1; |
| } | } |
| Line 215 main(int argc, char **argv) | Line 382 main(int argc, char **argv) |
| if (argc < 2) { | if (argc < 2) { |
| printf("Error:: host for connect not found, connection id or topic not supplied!\n\n"); | printf("Error:: host for connect not found, connection id or topic not supplied!\n\n"); |
| args->free(args); | args->free(args); |
| free(args); | e_free(args); |
| Usage(); | Usage(); |
| return 1; | return 1; |
| } else { | } else { |
| Line 226 main(int argc, char **argv) | Line 393 main(int argc, char **argv) |
| AIT_FREE_VAL(&args->Value); | AIT_FREE_VAL(&args->Value); |
| AIT_SET_STR(&args->Value, argv[2]); | AIT_SET_STR(&args->Value, argv[2]); |
| } | } |
| if (!io_gethostbyname(*argv, port, &args->addr)) { | if (!e_gethostbyname(*argv, port, &args->addr)) { |
| printf("Error:: host not valid #%d - %s\n", io_GetErrno(), io_GetError()); | printf("Error:: host not valid #%d - %s\n", elwix_GetErrno(), elwix_GetError()); |
| args->free(args); | args->free(args); |
| free(args); | e_free(args); |
| Usage(); | Usage(); |
| return 1; | return 1; |
| } | } |
| printf("Connecting to %s:%d ... ", io_n2addr(&args->addr, &val), io_n2port(&args->addr)); | printf("Connecting to %s:%d ... ", e_n2addr(&args->addr, &val), e_n2port(&args->addr)); |
| AIT_FREE_VAL(&val); | AIT_FREE_VAL(&val); |
| memset(&sa, 0, sizeof sa); | |
| sa.sa_handler = sigz; | |
| sigemptyset(&sa.sa_mask); | |
| sigaction(SIGTERM, &sa, NULL); | |
| sigaction(SIGINT, &sa, NULL); | |
| sigaction(SIGCHLD, &sa, NULL); | |
| if (!batch) | |
| switch (fork()) { | |
| case -1: /* error */ | |
| printf("Error:: in fork() #%d - %s\n", errno, strerror(errno)); | |
| ret = 2; | |
| goto end; | |
| case 0: /* child */ | |
| setsid(); | |
| ret = open("/dev/null", O_RDWR); | |
| if (ret != -1) { | |
| dup2(ret, STDIN_FILENO); | |
| dup2(ret, STDOUT_FILENO); | |
| dup2(ret, STDERR_FILENO); | |
| close(ret); | |
| } | |
| break; | |
| default: /* parent */ | |
| printf(">> Service started\n"); | |
| ret = 0; | |
| goto end; | |
| } | |
| if (!(args->cli = mqtt_cli_Open(&args->addr.sa, args->ka))) { | if (!(args->cli = mqtt_cli_Open(&args->addr.sa, args->ka))) { |
| args->free(args); | ret = 2; |
| free(args); | goto end; |
| return 2; | |
| } | } |
| switch ((ret = ConnectClient(args->cli->sock))) { | switch ((ret = ConnectClient(args->cli->sock))) { |
| Line 273 main(int argc, char **argv) | Line 469 main(int argc, char **argv) |
| lf = stdout; | lf = stdout; |
| if (lf) { | if (lf) { |
| ret = Subscribe(args->cli->sock, lf); | ret = Subscribe(args->cli->sock, lf); |
| root = schedBegin(); | |
| schedRead(root, pubRX, lf, args->cli->sock, NULL, 0); | |
| schedRun(root, &Kill); | |
| schedEnd(&root); | |
| if (un) | if (un) |
| Unsubscribe(args->cli->sock); | Unsubscribe(args->cli->sock); |
| fclose(lf); | fclose(lf); |
| } else | } else |
| printf("Error:: in subscribe file #%d - %s\n", errno, strerror(errno)); | printf("Error:: in output file #%d - %s\n", errno, strerror(errno)); |
| } else | } else |
| ret = 3; | ret = 3; |
| mqtt_cli_Close(&args->cli); | mqtt_cli_Close(&args->cli); |
| end: | |
| args->free(args); | args->free(args); |
| free(args); | e_free(args); |
| return ret; | return ret; |
| } | } |