| | |
| | | /*- |
| | | * Copyright (c) 2012-2013 Jan Breuer, |
| | | * BSD 2-Clause License |
| | | * |
| | | * All Rights Reserved |
| | | * Copyright (c) 2012-2018, Jan Breuer |
| | | * 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. |
| | | * modification, are permitted provided that the following conditions are met: |
| | | * |
| | | * THIS SOFTWARE IS PROVIDED BY THE AUTHORS ``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 AUTHORS 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. |
| | | * * Redistributions of source code must retain the above copyright notice, this |
| | | * list of conditions and the following disclaimer. |
| | | * |
| | | * * 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. |
| | | * |
| | | * 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 HOLDER 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. |
| | | */ |
| | | |
| | | /** |
| | |
| | | |
| | | int SCPI_Error(scpi_t * context, int_fast16_t err) { |
| | | (void) context; |
| | | // BEEP |
| | | /* BEEP */ |
| | | fprintf(stderr, "**ERROR: %d, \"%s\"\r\n", (int16_t) err, SCPI_ErrorTranslate(err)); |
| | | return 0; |
| | | } |
| | |
| | | if (context->user_context != NULL) { |
| | | user_data_t * u = (user_data_t *) (context->user_context); |
| | | if (u->control_io >= 0) { |
| | | snprintf(b, sizeof (b), "SRQ%d\r\n", val); |
| | | sprintf(b, "SRQ%d\r\n", val); |
| | | return write(u->control_io, b, strlen(b)) > 0 ? SCPI_RES_OK : SCPI_RES_ERR; |
| | | } |
| | | } |
| | |
| | | struct sockaddr_in servaddr; |
| | | |
| | | /* Configure TCP Server */ |
| | | bzero(&servaddr, sizeof (servaddr)); |
| | | memset(&servaddr, 0, sizeof (servaddr)); |
| | | servaddr.sin_family = AF_INET; |
| | | servaddr.sin_addr.s_addr = htonl(INADDR_ANY); |
| | | servaddr.sin_port = htons(port); |
| | |
| | | closeSrqIo(user_data); |
| | | printf("Control Connection closed\r\n"); |
| | | } else { |
| | | // nothing to do |
| | | /* nothing to do */ |
| | | } |
| | | } |
| | | |
| | |
| | | (void) argv; |
| | | int rc; |
| | | |
| | | #ifdef __cplusplus |
| | | user_data_t user_data = { |
| | | /*.io_listen =*/ -1, |
| | | /*.io =*/ -1, |
| | | /*.control_io_listen =*/ -1, |
| | | /*.control_io =*/ -1, |
| | | /*.fio =*/ NULL, |
| | | /*.fds =*/ 0, |
| | | }; |
| | | #else |
| | | user_data_t user_data = { |
| | | .io_listen = -1, |
| | | .io = -1, |
| | |
| | | .control_io = -1, |
| | | .fio = NULL, |
| | | }; |
| | | #endif |
| | | |
| | | // user_context will be pointer to socket |
| | | /* user_context will be pointer to socket */ |
| | | SCPI_Init(&scpi_context, |
| | | scpi_commands, |
| | | &scpi_interface, |
| | |
| | | while (1) { |
| | | rc = waitServer(&user_data); |
| | | |
| | | if (rc < 0) { // failed |
| | | if (rc < 0) { /* failed */ |
| | | perror("select failed"); |
| | | exit(-1); |
| | | } |
| | | |
| | | if (rc == 0) { // timeout |
| | | if (rc == 0) { /* timeout */ |
| | | SCPI_Input(&scpi_context, NULL, 0); |
| | | } |
| | | |