diff options
Diffstat (limited to 'ports/Win32/simcom.c')
| -rw-r--r-- | ports/Win32/simcom.c | 227 |
1 files changed, 0 insertions, 227 deletions
diff --git a/ports/Win32/simcom.c b/ports/Win32/simcom.c deleted file mode 100644 index 1b676b1f7..000000000 --- a/ports/Win32/simcom.c +++ /dev/null @@ -1,227 +0,0 @@ -/*
- ChibiOS/RT - Copyright (C) 2006-2007 Giovanni Di Sirio.
-
- This file is part of ChibiOS/RT.
-
- ChibiOS/RT 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 3 of the License, or
- (at your option) any later version.
-
- ChibiOS/RT 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 this program. If not, see <http://www.gnu.org/licenses/>.
-*/
-
-/*
- * Win32 COM port simulator (on socket).
- */
-
-#include <chconf.h>
-
-#include <windows.h>
-#include <stdio.h>
-
-#undef CDECL
-
-#include <ch.h>
-
-#define COM1PORT 29001
-#define COM2PORT 29002
-
-struct simcom {
-
- uint8_t com_ib[1024];
- uint8_t com_ob[1024];
- SOCKET com_listen;
- SOCKET com_data;
-};
-
-FullDuplexDriver COM1;
-static struct simcom sc1;
-FullDuplexDriver COM2;
-static struct simcom sc2;
-static u_long nb = 1;
-
-static void init(char *name, FullDuplexDriver *sd,
- struct simcom *sc, unsigned short port) {
- struct sockaddr_in sad;
- struct protoent *prtp;
-
- chFDDInit(sd,
- sc->com_ib, sizeof(sc->com_ib), NULL,
- sc->com_ob, sizeof(sc->com_ob), NULL);
-
- sc->com_listen = INVALID_SOCKET;
- sc->com_data = INVALID_SOCKET;
-
- if ((prtp = getprotobyname("tcp")) == NULL) {
- printf("%s: Error mapping protocol name to protocol number\n", name);
- goto abort;
- }
-
- sc->com_listen = socket(PF_INET, SOCK_STREAM, prtp->p_proto);
- if (sc->com_listen == INVALID_SOCKET) {
- printf("%s: Error creating simulator socket\n", name);
- goto abort;
- }
-
- if (ioctlsocket(sc->com_listen, FIONBIO, &nb) != 0) {
- printf("%s: Unable to setup non blocking mode on socket\n", 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(sc->com_listen, (struct sockaddr *)&sad, sizeof(sad))) {
- printf("%s: Error binding socket\n", name);
- goto abort;
- }
-
- if (listen(sc->com_listen, 1) != 0) {
- printf("%s: Error binding socket\n", name);
- goto abort;
- }
- printf("Full Duplex Channel %s listening on port %d\n", name, port);
- return;
-
-abort:
- if (sc->com_listen != INVALID_SOCKET)
- closesocket(sc->com_listen);
- WSACleanup();
- exit(1);
-}
-
-void InitSimCom1(void) {
-
- init("COM1", &COM1, &sc1, COM1PORT);
-}
-
-void InitSimCom2(void) {
-
- init("COM2", &COM2, &sc2, COM2PORT);
-}
-
-static bool_t connint(char *name, FullDuplexDriver *sd, struct simcom *sc) {
-
- if (sc->com_data == INVALID_SOCKET) {
- struct sockaddr addr;
- int addrlen = sizeof(addr);
-
- if ((sc->com_data = accept(sc->com_listen, &addr, &addrlen)) == INVALID_SOCKET)
- return FALSE;
-
- if (ioctlsocket(sc->com_data, FIONBIO, &nb) != 0) {
- printf("%s: Unable to setup non blocking mode on data socket\n", name);
- goto abort;
- }
- chFDDAddFlagsI(sd, SD_CONNECTED);
- return TRUE;
- }
- return FALSE;
-abort:
- if (sc->com_listen != INVALID_SOCKET)
- closesocket(sc->com_listen);
- if (sc->com_data != INVALID_SOCKET)
- closesocket(sc->com_data);
- WSACleanup();
- exit(1);
-}
-
-bool_t Com1ConnInterruptSimCom(void) {
-
- return connint("COM1", &COM1, &sc1);
-}
-
-bool_t Com2ConnInterruptSimCom(void) {
-
- return connint("COM2", &COM2, &sc2);
-}
-
-static bool_t inint(char *name, FullDuplexDriver *sd, struct simcom *sc) {
-
- if (sc->com_data != INVALID_SOCKET) {
- int i;
- uint8_t data[32];
-
- /*
- * Input.
- */
- int n = recv(sc->com_data, data, sizeof(data), 0);
- switch (n) {
- case 0:
- closesocket(sc->com_data);
- sc->com_data = INVALID_SOCKET;
- chFDDAddFlagsI(sd, SD_DISCONNECTED);
- return FALSE;
- case SOCKET_ERROR:
- if (WSAGetLastError() == WSAEWOULDBLOCK)
- return FALSE;
- closesocket(sc->com_data);
- sc->com_data = INVALID_SOCKET;
- return FALSE;
- }
- for (i = 0; i < n; i++)
- chFDDIncomingDataI(sd, data[i]);
- return TRUE;
- }
- return FALSE;
-}
-
-bool_t Com1InInterruptSimCom(void) {
-
- return inint("COM1", &COM1, &sc1);
-}
-
-bool_t Com2InInterruptSimCom(void) {
-
- return inint("COM2", &COM2, &sc2);
-}
-
-static bool_t outint(char *name, FullDuplexDriver *sd, struct simcom *sc) {
-
- if (sc->com_data != INVALID_SOCKET) {
- int n;
- uint8_t data[1];
-
- /*
- * Input.
- */
- n = chFDDRequestDataI(sd);
- if (n < 0)
- return FALSE;
- data[0] = (uint8_t)n;
- n = send(sc->com_data, data, sizeof(data), 0);
- switch (n) {
- case 0:
- closesocket(sc->com_data);
- sc->com_data = INVALID_SOCKET;
- chFDDAddFlagsI(sd, SD_DISCONNECTED);
- return FALSE;
- case SOCKET_ERROR:
- if (WSAGetLastError() == WSAEWOULDBLOCK)
- return FALSE;
- closesocket(sc->com_data);
- sc->com_data = INVALID_SOCKET;
- return FALSE;
- }
- return TRUE;
- }
- return FALSE;
-}
-
-bool_t Com1OutInterruptSimCom(void) {
-
- return outint("COM1", &COM1, &sc1);
-}
-
-bool_t Com2OutInterruptSimCom(void) {
-
- return outint("COM2", &COM2, &sc2);
-}
|