| | |
| | | /*- |
| | | * 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. |
| | | */ |
| | | |
| | | /** |
| | |
| | | #include "task.h" |
| | | #include "lwip/tcp.h" |
| | | #include "lwip/inet.h" |
| | | |
| | | |
| | | #define DEVICE_PORT 5025 |
| | | #define CONTROL_PORT 5026 |
| | | |
| | | #define SCPI_THREAD_PRIO (tskIDLE_PRIORITY + 2) |
| | | |
| | |
| | | iprintf("**ERROR: %ld, \"%s\"\r\n", (int32_t) err, SCPI_ErrorTranslate(err)); |
| | | if (err != 0) { |
| | | /* New error */ |
| | | /* Beep */ |
| | | /* Error LED ON */ |
| | | SCPI_Event_ErrorIndicatorOn(context, err); |
| | | } else { |
| | | /* No more errors in the queue */ |
| | | /* Error LED OFF */ |
| | | SCPI_Event_ErrorIndicatorOff(context, err); |
| | | } |
| | | return 0; |
| | | } |
| | |
| | | } |
| | | |
| | | scpi_result_t SCPI_SystemCommTcpipControlQ(scpi_t * context) { |
| | | SCPI_ResultInt(context, CONTROL_PORT); |
| | | SCPI_ResultInt(context, SCPI_CONTROL_PORT); |
| | | return SCPI_RES_OK; |
| | | } |
| | | |
| | |
| | | } |
| | | |
| | | void SCPI_RequestControl(void) { |
| | | BaseType_t xReturned; |
| | | queue_event_t msg; |
| | | msg.cmd = SCPI_MSG_SET_ESE_REQ; |
| | | |
| | |
| | | } |
| | | */ |
| | | |
| | | xQueueSend(user_data.evtQueue, &msg, 1000); |
| | | xReturned = xQueueSend(user_data.evtQueue, &msg, 1000); |
| | | /* @fixme: replace by real error handling code */ |
| | | LWIP_ASSERT("SCPI_RequestControl failed", xReturned == pdPASS); |
| | | } |
| | | |
| | | void SCPI_AddError(int16_t err) { |
| | | BaseType_t xReturned; |
| | | queue_event_t msg; |
| | | msg.cmd = SCPI_MSG_SET_ERROR; |
| | | msg.param2 = err; |
| | | |
| | | xQueueSend(user_data.evtQueue, &msg, 1000); |
| | | xReturned = xQueueSend(user_data.evtQueue, &msg, 1000); |
| | | /* @fixme: replace by real error handling code */ |
| | | LWIP_ASSERT("SCPI_AddError failed", xReturned == pdPASS); |
| | | } |
| | | |
| | | void scpi_netconn_callback(struct netconn * conn, enum netconn_evt evt, u16_t len) { |
| | | BaseType_t xReturned; |
| | | queue_event_t msg; |
| | | (void) len; |
| | | |
| | |
| | | } else if (conn == user_data.control_io_listen) { |
| | | msg.cmd = SCPI_MSG_CONTROL_IO_LISTEN; |
| | | } |
| | | xQueueSend(user_data.evtQueue, &msg, 1000); |
| | | xReturned = xQueueSend(user_data.evtQueue, &msg, 1000); |
| | | /* @fixme: replace by real error handling code */ |
| | | LWIP_ASSERT("scpi_netconn_callback failed", xReturned == pdPASS); |
| | | } |
| | | } |
| | | |
| | |
| | | netconn_delete(newconn); |
| | | } else { |
| | | /* connection established */ |
| | | SCPI_Event_DeviceConnected(newconn); |
| | | iprintf("***Connection established %s\r\n", inet_ntoa(newconn->pcb.ip->remote_ip)); |
| | | user_data->io = newconn; |
| | | } |
| | |
| | | |
| | | static void closeIo(user_data_t * user_data) { |
| | | /* connection closed */ |
| | | SCPI_Event_DeviceDisconnected(user_data->io); |
| | | netconn_close(user_data->io); |
| | | netconn_delete(user_data->io); |
| | | user_data->io = NULL; |
| | |
| | | (void) arg; |
| | | |
| | | user_data.evtQueue = xQueueCreate(10, sizeof (queue_event_t)); |
| | | LWIP_ASSERT("user_data.evtQueue != NULL", user_data.evtQueue != NULL); |
| | | |
| | | /* user_context will be pointer to socket */ |
| | | SCPI_Init(&scpi_context, |
| | |
| | | |
| | | scpi_context.user_context = &user_data; |
| | | |
| | | user_data.io_listen = createServer(DEVICE_PORT); |
| | | user_data.control_io_listen = createServer(CONTROL_PORT); |
| | | user_data.io_listen = createServer(SCPI_DEVICE_PORT); |
| | | LWIP_ASSERT("user_data.io_listen != NULL", user_data.io_listen != NULL); |
| | | |
| | | user_data.control_io_listen = createServer(SCPI_CONTROL_PORT); |
| | | LWIP_ASSERT("user_data.control_io_listen != NULL", user_data.control_io_listen != NULL); |
| | | |
| | | while (1) { |
| | | waitServer(&user_data, &evt); |
| | |
| | | } |
| | | |
| | | void scpi_server_init(void) { |
| | | sys_thread_new("SCPI", scpi_server_thread, NULL, 2 * DEFAULT_THREAD_STACKSIZE, SCPI_THREAD_PRIO); |
| | | } |
| | | TaskHandle_t xHandle = NULL; |
| | | BaseType_t xReturned; |
| | | xReturned = xTaskCreate(scpi_server_thread, "SCPI", DEFAULT_THREAD_STACKSIZE, NULL, SCPI_THREAD_PRIO, &xHandle); |
| | | LWIP_ASSERT("scpi_server_init failed", xReturned == pdPASS); |
| | | } |
| | | |
| | | /* Called by processIoListen() for additional reporting. Override on demand. */ |
| | | void __attribute__((weak)) SCPI_Event_DeviceConnected(struct netconn * conn) { |
| | | /* Remote or Eth LED ON */ |
| | | } |
| | | |
| | | /* Called by closeIO() for additional reporting. Override on demand. */ |
| | | void __attribute__((weak)) SCPI_Event_DeviceDisconnected(struct netconn * conn) { |
| | | /* Remote or Eth LED OFF */ |
| | | } |
| | | |
| | | /* Called by SCPI_Error() for reporting. Override on demand. */ |
| | | void __attribute__((weak)) SCPI_Event_ErrorIndicatorOn(scpi_t * context, int_fast16_t err) { |
| | | /* New error : Beep, Error LED ON */ |
| | | } |
| | | |
| | | /* Called by SCPI_Error() for reporting. Override on demand. */ |
| | | void __attribute__((weak)) SCPI_Event_ErrorIndicatorOff(scpi_t * context, int_fast16_t err) { |
| | | /* No more errors in the queue : Error LED OFF */ |
| | | } |