5 files changed, 612 insertions, 0 deletions
diff --git a/os/hal/ports/simulator/posix/hal_lld.c b/os/hal/ports/simulator/posix/hal_lld.c
new file mode 100755
index 000000000..52adb4e4c
--- /dev/null
+++ b/os/hal/ports/simulator/posix/hal_lld.c
@@ -0,0 +1,110 @@
+/*
+    ChibiOS - Copyright (C) 2006..2016 Giovanni Di Sirio
+
+    Licensed under the Apache License, Version 2.0 (the "License");
+    you may not use this file except in compliance with the License.
+    You may obtain a copy of the License at
+
+        http://www.apache.org/licenses/LICENSE-2.0
+
+    Unless required by applicable law or agreed to in writing, software
+    distributed under the License is distributed on an "AS IS" BASIS,
+    WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
+    See the License for the specific language governing permissions and
+    limitations under the License.
+*/
+
+/**
+ * @file    simulator/posix/hal_lld.c
+ * @brief   Posix simulator HAL subsystem low level driver code.
+ *
+ * @addtogroup POSIX_HAL
+ * @{
+ */
+
+#include "hal.h"
+
+/*===========================================================================*/
+/* Driver exported variables.                                                */
+/*===========================================================================*/
+
+/*===========================================================================*/
+/* Driver local variables and types.                                         */
+/*===========================================================================*/
+
+static LARGE_INTEGER nextcnt;
+static LARGE_INTEGER slice;
+
+/*===========================================================================*/
+/* Driver local functions.                                                   */
+/*===========================================================================*/
+
+/*===========================================================================*/
+/* Driver interrupt handlers.                                                */
+/*===========================================================================*/
+
+/*===========================================================================*/
+/* Driver exported functions.                                                */
+/*===========================================================================*/
+
+/**
+ * @brief Low level HAL driver initialization.
+ */
+void hal_lld_init(void) {
+  WSADATA wsaData;
+
+  /* Initialization.*/
+  if (WSAStartup(2, &wsaData) != 0) {
+    printf("Unable to locate a winsock DLL\n");
+    exit(1);
+  }
+
+  printf("ChibiOS/RT simulator (Win32)\n");
+  if (!QueryPerformanceFrequency(&slice)) {
+    printf("QueryPerformanceFrequency() error");
+    exit(1);
+  }
+  slice.QuadPart /= CH_CFG_ST_FREQUENCY;
+  QueryPerformanceCounter(&nextcnt);
+  nextcnt.QuadPart += slice.QuadPart;
+
+  fflush(stdout);
+}
+
+/**
+ * @brief   Interrupt simulation.
+ */
+void _sim_check_for_interrupts(void) {
+  LARGE_INTEGER n;
+
+#if HAL_USE_SERIAL
+  if (sd_lld_interrupt_pending()) {
+    _dbg_check_lock();
+    if (chSchIsPreemptionRequired())
+      chSchDoReschedule();
+    _dbg_check_unlock();
+    return;
+  }
+#endif
+
+  /* Interrupt Timer simulation (10ms interval).*/
+  QueryPerformanceCounter(&n);
+  if (n.QuadPart > nextcnt.QuadPart) {
+    nextcnt.QuadPart += slice.QuadPart;
+
+    CH_IRQ_PROLOGUE();
+
+    chSysLockFromISR();
+    chSysTimerHandlerI();
+    chSysUnlockFromISR();
+
+    CH_IRQ_EPILOGUE();
+
+    _dbg_check_lock();
+    if (chSchIsPreemptionRequired())
+      chSchDoReschedule();
+    _dbg_check_unlock();
+  }
+}
+
+/** @} */
diff --git a/os/hal/ports/simulator/posix/hal_lld.h b/os/hal/ports/simulator/posix/hal_lld.h
new file mode 100755
index 000000000..2a1dbf933
--- /dev/null
+++ b/os/hal/ports/simulator/posix/hal_lld.h
@@ -0,0 +1,67 @@
+/*
+    ChibiOS - Copyright (C) 2006..2016 Giovanni Di Sirio
+
+    Licensed under the Apache License, Version 2.0 (the "License");
+    you may not use this file except in compliance with the License.
+    You may obtain a copy of the License at
+
+        http://www.apache.org/licenses/LICENSE-2.0
+
+    Unless required by applicable law or agreed to in writing, software
+    distributed under the License is distributed on an "AS IS" BASIS,
+    WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
+    See the License for the specific language governing permissions and
+    limitations under the License.
+*/
+
+/**
+ * @file    simulator/posix/hal_lld.h
+ * @brief   Posix simulator HAL subsystem low level driver header.
+ *
+ * @addtogroup POSIX_HAL
+ * @{
+ */
+
+#ifndef HAL_LLD_H
+#define HAL_LLD_H
+
+#include <windows.h>
+#include <stdio.h>
+
+/*===========================================================================*/
+/* Driver constants.                                                         */
+/*===========================================================================*/
+
+/**
+ * @brief   Platform name.
+ */
+#define PLATFORM_NAME   "Win32 Simulator"
+
+/*===========================================================================*/
+/* Driver pre-compile time settings.                                         */
+/*===========================================================================*/
+
+/*===========================================================================*/
+/* Derived constants and error checks.                                       */
+/*===========================================================================*/
+
+/*===========================================================================*/
+/* Driver data structures and types.                                         */
+/*===========================================================================*/
+
+/*===========================================================================*/
+/* External declarations.                                                    */
+/*===========================================================================*/
+
+#ifdef __cplusplus
+extern "C" {
+#endif
+  void hal_lld_init(void);
+  void _sim_check_for_interrupts(void);
+#ifdef __cplusplus
+}
+#endif
+
+#endif /* HAL_LLD_H */
+
+/** @} */
diff --git a/os/hal/ports/simulator/posix/hal_serial_lld.c b/os/hal/ports/simulator/posix/hal_serial_lld.c
new file mode 100755
index 000000000..99a75199a
--- /dev/null
+++ b/os/hal/ports/simulator/posix/hal_serial_lld.c
@@ -0,0 +1,282 @@
+/*
+    ChibiOS - Copyright (C) 2006..2016 Giovanni Di Sirio
+
+    Licensed under the Apache License, Version 2.0 (the "License");
+    you may not use this file except in compliance with the License.
+    You may obtain a copy of the License at
+
+        http://www.apache.org/licenses/LICENSE-2.0
+
+    Unless required by applicable law or agreed to in writing, software
+    distributed under the License is distributed on an "AS IS" BASIS,
+    WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
+    See the License for the specific language governing permissions and
+    limitations under the License.
+*/
+
+/**
+ * @file    simulator/posix/hal_serial_lld.c
+ * @brief   Posix simulator low level serial driver code.
+ *
+ * @addtogroup POSIX_SERIAL
+ * @{
+ */
+
+#include "hal.h"
+
+#if HAL_USE_SERIAL || defined(__DOXYGEN__)
+
+/*===========================================================================*/
+/* Driver exported variables.                                                */
+/*===========================================================================*/
+
+/** @brief Serial driver 1 identifier.*/
+#if USE_WIN32_SERIAL1 || defined(__DOXYGEN__)
+SerialDriver SD1;
+#endif
+/** @brief Serial driver 2 identifier.*/
+#if USE_WIN32_SERIAL2 || defined(__DOXYGEN__)
+SerialDriver SD2;
+#endif
+
+/*===========================================================================*/
+/* Driver local variables and types.                                         */
+/*===========================================================================*/
+
+/** @brief Driver default configuration.*/
+static const SerialConfig default_config = {
+};
+
+static u_long nb = 1;
+
+/*===========================================================================*/
+/* Driver local functions.                                                   */
+/*===========================================================================*/
+
+static void init(SerialDriver *sdp, uint16_t port) {
+  struct sockaddr_in sad;
+  struct protoent *prtp;
+
+  if ((prtp = getprotobyname("tcp")) == NULL) {
+    printf("%s: Error mapping protocol name to protocol number\n", sdp->com_name);
+    goto abort;
+  }
+
+  sdp->com_listen = socket(PF_INET, SOCK_STREAM, prtp->p_proto);
+  if (sdp->com_listen == INVALID_SOCKET) {
+    printf("%s: Error creating simulator socket\n", sdp->com_name);
+    goto abort;
+  }
+
+  if (ioctlsocket(sdp->com_listen, FIONBIO, &nb) != 0) {
+    printf("%s: Unable to setup non blocking mode on socket\n", sdp->com_name);
+    goto abort;
+  }
+
+  memset(&sad, 0, sizeof(sad));
+  sad.sin_family = AF_INET;
+  sad.sin_addr.s_addr = INADDR_ANY;
+  sad.sin_port = htons(port);
+  if (bind(sdp->com_listen, (struct sockaddr *)&sad, sizeof(sad))) {
+    printf("%s: Error binding socket\n", sdp->com_name);
+    goto abort;
+  }
+
+  if (listen(sdp->com_listen, 1) != 0) {
+    printf("%s: Error listening socket\n", sdp->com_name);
+    goto abort;
+  }
+  printf("Full Duplex Channel %s listening on port %d\n", sdp->com_name, port);
+  return;
+
+abort:
+  if (sdp->com_listen != INVALID_SOCKET)
+    closesocket(sdp->com_listen);
+  WSACleanup();
+  exit(1);
+}
+
+static bool connint(SerialDriver *sdp) {
+
+  if (sdp->com_data == INVALID_SOCKET) {
+    struct sockaddr addr;
+    int addrlen = sizeof(addr);
+
+    if ((sdp->com_data = accept(sdp->com_listen, &addr, &addrlen)) == INVALID_SOCKET)
+      return FALSE;
+
+    if (ioctlsocket(sdp->com_data, FIONBIO, &nb) != 0) {
+      printf("%s: Unable to setup non blocking mode on data socket\n", sdp->com_name);
+      goto abort;
+    }
+    chSysLockFromISR();
+    chnAddFlagsI(sdp, CHN_CONNECTED);
+    chSysUnlockFromISR();
+    return TRUE;
+  }
+  return FALSE;
+abort:
+  if (sdp->com_listen != INVALID_SOCKET)
+    closesocket(sdp->com_listen);
+  if (sdp->com_data != INVALID_SOCKET)
+    closesocket(sdp->com_data);
+  WSACleanup();
+  exit(1);
+}
+
+static bool inint(SerialDriver *sdp) {
+
+  if (sdp->com_data != INVALID_SOCKET) {
+    int i;
+    uint8_t data[32];
+
+    /*
+     * Input.
+     */
+    int n = recv(sdp->com_data, (char *)data, sizeof(data), 0);
+    switch (n) {
+    case 0:
+      closesocket(sdp->com_data);
+      sdp->com_data = INVALID_SOCKET;
+      chSysLockFromISR();
+      chnAddFlagsI(sdp, CHN_DISCONNECTED);
+      chSysUnlockFromISR();
+      return FALSE;
+    case SOCKET_ERROR:
+      if (WSAGetLastError() == WSAEWOULDBLOCK)
+        return FALSE;
+      closesocket(sdp->com_data);
+      sdp->com_data = INVALID_SOCKET;
+      return FALSE;
+    }
+    for (i = 0; i < n; i++) {
+      chSysLockFromISR();
+      sdIncomingDataI(sdp, data[i]);
+      chSysUnlockFromISR();
+    }
+    return TRUE;
+  }
+  return FALSE;
+}
+
+static bool outint(SerialDriver *sdp) {
+
+  if (sdp->com_data != INVALID_SOCKET) {
+    int n;
+    uint8_t data[1];
+
+    /*
+     * Input.
+     */
+    chSysLockFromISR();
+    n = sdRequestDataI(sdp);
+    chSysUnlockFromISR();
+    if (n < 0)
+      return FALSE;
+    data[0] = (uint8_t)n;
+    n = send(sdp->com_data, (char *)data, sizeof(data), 0);
+    switch (n) {
+    case 0:
+      closesocket(sdp->com_data);
+      sdp->com_data = INVALID_SOCKET;
+      chSysLockFromISR();
+      chnAddFlagsI(sdp, CHN_DISCONNECTED);
+      chSysUnlockFromISR();
+      return FALSE;
+    case SOCKET_ERROR:
+      if (WSAGetLastError() == WSAEWOULDBLOCK)
+        return FALSE;
+      closesocket(sdp->com_data);
+      sdp->com_data = INVALID_SOCKET;
+      return FALSE;
+    }
+    return TRUE;
+  }
+  return FALSE;
+}
+
+/*===========================================================================*/
+/* Driver interrupt handlers.                                                */
+/*===========================================================================*/
+
+/*===========================================================================*/
+/* Driver exported functions.                                                */
+/*===========================================================================*/
+
+/**
+ * Low level serial driver initialization.
+ */
+void sd_lld_init(void) {
+
+#if USE_WIN32_SERIAL1
+  sdObjectInit(&SD1, NULL, NULL);
+  SD1.com_listen = INVALID_SOCKET;
+  SD1.com_data = INVALID_SOCKET;
+  SD1.com_name = "SD1";
+#endif
+
+#if USE_WIN32_SERIAL2
+  sdObjectInit(&SD2, NULL, NULL);
+  SD2.com_listen = INVALID_SOCKET;
+  SD2.com_data = INVALID_SOCKET;
+  SD2.com_name = "SD2";
+#endif
+}
+
+/**
+ * @brief   Low level serial driver configuration and (re)start.
+ *
+ * @param[in] sdp       pointer to a @p SerialDriver object
+ * @param[in] config    the architecture-dependent serial driver configuration.
+ *                      If this parameter is set to @p NULL then a default
+ *                      configuration is used.
+ */
+void sd_lld_start(SerialDriver *sdp, const SerialConfig *config) {
+
+  if (config == NULL)
+    config = &default_config;
+
+#if USE_WIN32_SERIAL1
+  if (sdp == &SD1)
+    init(&SD1, SD1_PORT);
+#endif
+
+#if USE_WIN32_SERIAL2
+  if (sdp == &SD2)
+    init(&SD2, SD2_PORT);
+#endif
+}
+
+/**
+ * @brief Low level serial driver stop.
+ * @details De-initializes the USART, stops the associated clock, resets the
+ *          interrupt vector.
+ *
+ * @param[in] sdp pointer to a @p SerialDriver object
+ */
+void sd_lld_stop(SerialDriver *sdp) {
+
+  (void)sdp;
+}
+
+bool sd_lld_interrupt_pending(void) {
+  bool b = false;
+
+  CH_IRQ_PROLOGUE();
+
+#if USE_WIN32_SERIAL1
+  b |= connint(&SD1) || inint(&SD1) || outint(&SD1);
+#endif
+
+#if USE_WIN32_SERIAL2
+  b |= connint(&SD2) || inint(&SD2) || outint(&SD2);
+#endif
+
+  CH_IRQ_EPILOGUE();
+
+  return b;
+}
+
+#endif /* HAL_USE_SERIAL */
+
+/** @} */
diff --git a/os/hal/ports/simulator/posix/hal_serial_lld.h b/os/hal/ports/simulator/posix/hal_serial_lld.h
new file mode 100755
index 000000000..de228111f
--- /dev/null
+++ b/os/hal/ports/simulator/posix/hal_serial_lld.h
@@ -0,0 +1,143 @@
+/*
+    ChibiOS - Copyright (C) 2006..2016 Giovanni Di Sirio
+
+    Licensed under the Apache License, Version 2.0 (the "License");
+    you may not use this file except in compliance with the License.
+    You may obtain a copy of the License at
+
+        http://www.apache.org/licenses/LICENSE-2.0
+
+    Unless required by applicable law or agreed to in writing, software
+    distributed under the License is distributed on an "AS IS" BASIS,
+    WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
+    See the License for the specific language governing permissions and
+    limitations under the License.
+*/
+
+/**
+ * @file    simulator/posix/hal_serial_lld.h
+ * @brief   Posix simulator low level serial driver header.
+ *
+ * @addtogroup POSIX_SERIAL
+ * @{
+ */
+
+#ifndef HAL_SERIAL_LLD_H
+#define HAL_SERIAL_LLD_H
+
+#if HAL_USE_SERIAL || defined(__DOXYGEN__)
+
+/*===========================================================================*/
+/* Driver pre-compile time settings.                                         */
+/*===========================================================================*/
+
+/**
+ * @brief   Serial buffers size.
+ * @details Configuration parameter, you can change the depth of the queue
+ *          buffers depending on the requirements of your application.
+ */
+#if !defined(SERIAL_BUFFERS_SIZE) || defined(__DOXYGEN__)
+#define SERIAL_BUFFERS_SIZE                 1024
+#endif
+
+/**
+ * @brief   SD1 driver enable switch.
+ * @details If set to @p TRUE the support for SD1 is included.
+ * @note    The default is @p TRUE.
+ */
+#if !defined(USE_WIN32_SERIAL1) || defined(__DOXYGEN__)
+#define USE_WIN32_SERIAL1                   TRUE
+#endif
+
+/**
+ * @brief   SD2 driver enable switch.
+ * @details If set to @p TRUE the support for SD2 is included.
+ * @note    The default is @p TRUE.
+ */
+#if !defined(USE_WIN32_SERIAL2) || defined(__DOXYGEN__)
+#define USE_WIN32_SERIAL2                   TRUE
+#endif
+
+/**
+ * @brief   Listen port for SD1.
+ */
+#if !defined(SD1_PORT) || defined(__DOXYGEN__)
+#define SD1_PORT                            29001
+#endif
+
+/**
+ * @brief   Listen port for SD2.
+ */
+#if !defined(SD2_PORT) || defined(__DOXYGEN__)
+#define SD2_PORT                            29002
+#endif
+
+/*===========================================================================*/
+/* Unsupported event flags and custom events.                                */
+/*===========================================================================*/
+
+/*===========================================================================*/
+/* Driver data structures and types.                                         */
+/*===========================================================================*/
+
+/**
+ * @brief   Generic Serial Driver configuration structure.
+ * @details An instance of this structure must be passed to @p sdStart()
+ *          in order to configure and start a serial driver operations.
+ * @note    This structure content is architecture dependent, each driver
+ *          implementation defines its own version and the custom static
+ *          initializers.
+ */
+typedef struct {
+} SerialConfig;
+
+/**
+ * @brief   @p SerialDriver specific data.
+ */
+#define _serial_driver_data                                                 \
+  _base_asynchronous_channel_data                                           \
+  /* Driver state.*/                                                        \
+  sdstate_t                 state;                                          \
+  /* Input queue.*/                                                         \
+  input_queue_t             iqueue;                                         \
+  /* Output queue.*/                                                        \
+  output_queue_t            oqueue;                                         \
+  /* Input circular buffer.*/                                               \
+  uint8_t                   ib[SERIAL_BUFFERS_SIZE];                        \
+  /* Output circular buffer.*/                                              \
+  uint8_t                   ob[SERIAL_BUFFERS_SIZE];                        \
+  /* End of the mandatory fields.*/                                         \
+  /* Listen socket for simulated serial port.*/                             \
+  SOCKET                    com_listen;                                     \
+  /* Data socket for simulated serial port.*/                               \
+  SOCKET                    com_data;                                       \
+  /* Port readable name.*/                                                  \
+  const char                *com_name;
+
+/*===========================================================================*/
+/* External declarations.                                                    */
+/*===========================================================================*/
+
+#if USE_WIN32_SERIAL1 && !defined(__DOXYGEN__)
+extern SerialDriver SD1;
+#endif
+#if USE_WIN32_SERIAL2 && !defined(__DOXYGEN__)
+extern SerialDriver SD2;
+#endif
+
+#ifdef __cplusplus
+extern "C" {
+#endif
+  void sd_lld_init(void);
+  void sd_lld_start(SerialDriver *sdp, const SerialConfig *config);
+  void sd_lld_stop(SerialDriver *sdp);
+  bool sd_lld_interrupt_pending(void);
+#ifdef __cplusplus
+}
+#endif
+
+#endif /* HAL_USE_SERIAL */
+
+#endif /* HAL_SERIAL_LLD_H */
+
+/** @} */
diff --git a/os/hal/ports/simulator/posix/platform.mk b/os/hal/ports/simulator/posix/platform.mk
new file mode 100755
index 000000000..1d84f866e
--- /dev/null
+++ b/os/hal/ports/simulator/posix/platform.mk
@@ -0,0 +1,10 @@
+# List of all the Win32 platform files.
+PLATFORMSRC = ${CHIBIOS}/os/hal/ports/simulator/posix/hal_lld.c \
+              ${CHIBIOS}/os/hal/ports/simulator/posix/hal_serial_lld.c \
+              ${CHIBIOS}/os/hal/ports/simulator/console.c \
+              ${CHIBIOS}/os/hal/ports/simulator/hal_pal_lld.c \
+              ${CHIBIOS}/os/hal/ports/simulator/hal_st_lld.c
+
+# Required include directories
+PLATFORMINC = ${CHIBIOS}/os/hal/ports/simulator/posix \
+              ${CHIBIOS}/os/hal/ports/simulator