git-svn-id: svn://svn.code.sf.net/p/chibios/svn/trunk@1141 35acf78f-673a-0410-8e92-d51de3d6d3f4
gdisirio
parent
c70d45e093
commit
58f6aa17ff
|
|
@ -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);
|
|
||||||
}
|
|
||||||
|
|
@ -1,201 +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 ISO7816 port simulator (on socket).
|
|
||||||
*/
|
|
||||||
|
|
||||||
#include <chconf.h>
|
|
||||||
|
|
||||||
#include <windows.h>
|
|
||||||
#include <stdio.h>
|
|
||||||
|
|
||||||
#undef CDECL
|
|
||||||
|
|
||||||
#include <ch.h>
|
|
||||||
|
|
||||||
#define ISO7816PORT1 29021
|
|
||||||
|
|
||||||
typedef struct {
|
|
||||||
|
|
||||||
BYTE8 io_b[16];
|
|
||||||
SOCKET io_listen;
|
|
||||||
SOCKET io_data;
|
|
||||||
} sim7816;
|
|
||||||
|
|
||||||
HalfDuplexDriver ISO1;
|
|
||||||
static sim7816 sim1;
|
|
||||||
static u_long nb = 1;
|
|
||||||
|
|
||||||
static void init(char *name, HalfDuplexDriver *sd, sim7816 *simp, unsigned short port) {
|
|
||||||
|
|
||||||
struct sockaddr_in sad;
|
|
||||||
struct protoent *prtp;
|
|
||||||
|
|
||||||
chHDDInit(sd, simp->io_b, sizeof(simp->io_b), NULL, NULL);
|
|
||||||
|
|
||||||
simp->io_listen = INVALID_SOCKET;
|
|
||||||
simp->io_data = INVALID_SOCKET;
|
|
||||||
|
|
||||||
if ((prtp = getprotobyname("tcp")) == NULL) {
|
|
||||||
printf("%s: Error mapping protocol name to protocol number\n", name);
|
|
||||||
goto abort;
|
|
||||||
}
|
|
||||||
|
|
||||||
simp->io_listen = socket(PF_INET, SOCK_STREAM, prtp->p_proto);
|
|
||||||
if (simp->io_listen == INVALID_SOCKET) {
|
|
||||||
printf("%s: Error creating simulator socket\n", name);
|
|
||||||
goto abort;
|
|
||||||
}
|
|
||||||
|
|
||||||
if (ioctlsocket(simp->io_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(simp->io_listen, (struct sockaddr *)&sad, sizeof(sad))) {
|
|
||||||
printf("%s: Error binding socket\n", name);
|
|
||||||
goto abort;
|
|
||||||
}
|
|
||||||
|
|
||||||
if (listen(simp->io_listen, 1) != 0) {
|
|
||||||
printf("%s: Error binding socket\n", name);
|
|
||||||
goto abort;
|
|
||||||
}
|
|
||||||
printf("Half Duplex channel %s listening on port %d\n", name, port);
|
|
||||||
return;
|
|
||||||
|
|
||||||
abort:
|
|
||||||
if (simp->io_listen != INVALID_SOCKET)
|
|
||||||
closesocket(simp->io_listen);
|
|
||||||
WSACleanup();
|
|
||||||
exit(1);
|
|
||||||
}
|
|
||||||
|
|
||||||
void InitSimIso1(void) {
|
|
||||||
|
|
||||||
init("ISO1", &ISO1, &sim1, ISO7816PORT1);
|
|
||||||
}
|
|
||||||
|
|
||||||
static BOOL connint(char *name, HalfDuplexDriver *sd, sim7816 *simp) {
|
|
||||||
|
|
||||||
if (simp->io_data == INVALID_SOCKET) {
|
|
||||||
struct sockaddr addr;
|
|
||||||
int addrlen = sizeof(addr);
|
|
||||||
|
|
||||||
if ((simp->io_data = accept(simp->io_listen, &addr, &addrlen)) == INVALID_SOCKET)
|
|
||||||
return FALSE;
|
|
||||||
|
|
||||||
if (ioctlsocket(simp->io_data, FIONBIO, &nb) != 0) {
|
|
||||||
printf("%s: Unable to setup non blocking mode on data socket\n", name);
|
|
||||||
goto abort;
|
|
||||||
}
|
|
||||||
chHDDAddFlagsI(sd, SD_CONNECTED);
|
|
||||||
return TRUE;
|
|
||||||
}
|
|
||||||
return FALSE;
|
|
||||||
abort:
|
|
||||||
if (simp->io_listen != INVALID_SOCKET)
|
|
||||||
closesocket(simp->io_listen);
|
|
||||||
if (simp->io_data != INVALID_SOCKET)
|
|
||||||
closesocket(simp->io_data);
|
|
||||||
WSACleanup();
|
|
||||||
exit(1);
|
|
||||||
}
|
|
||||||
|
|
||||||
BOOL Iso1ConnInterrupt(void) {
|
|
||||||
|
|
||||||
return connint("ISO1", &ISO1, &sim1);
|
|
||||||
}
|
|
||||||
|
|
||||||
static BOOL inint(char *name, HalfDuplexDriver *sd, sim7816 *simp) {
|
|
||||||
|
|
||||||
if (simp->io_data != INVALID_SOCKET) {
|
|
||||||
int i;
|
|
||||||
BYTE8 data[4];
|
|
||||||
|
|
||||||
/*
|
|
||||||
* Input.
|
|
||||||
*/
|
|
||||||
int n = recv(simp->io_data, data, sizeof(data), 0);
|
|
||||||
switch (n) {
|
|
||||||
case 0:
|
|
||||||
closesocket(simp->io_data);
|
|
||||||
simp->io_data = INVALID_SOCKET;
|
|
||||||
chHDDAddFlagsI(sd, SD_DISCONNECTED);
|
|
||||||
return FALSE;
|
|
||||||
case SOCKET_ERROR:
|
|
||||||
if (WSAGetLastError() == WSAEWOULDBLOCK)
|
|
||||||
return FALSE;
|
|
||||||
closesocket(simp->io_data);
|
|
||||||
simp->io_data = INVALID_SOCKET;
|
|
||||||
return FALSE;
|
|
||||||
}
|
|
||||||
for (i = 0; i < n; i++)
|
|
||||||
chHDDIncomingDataI(sd, data[i]);
|
|
||||||
return TRUE;
|
|
||||||
}
|
|
||||||
return FALSE;
|
|
||||||
}
|
|
||||||
|
|
||||||
BOOL Iso1InInterrupt(void) {
|
|
||||||
|
|
||||||
return inint("ISO", &ISO1, &sim1);
|
|
||||||
}
|
|
||||||
|
|
||||||
static BOOL outint(char *name, HalfDuplexDriver *sd, sim7816 *simp) {
|
|
||||||
|
|
||||||
if (simp->io_data != INVALID_SOCKET) {
|
|
||||||
short n;
|
|
||||||
BYTE8 data[1];
|
|
||||||
|
|
||||||
/*
|
|
||||||
* Input.
|
|
||||||
*/
|
|
||||||
n = chHDDRequestDataI(sd);
|
|
||||||
if (n < 0)
|
|
||||||
return FALSE;
|
|
||||||
data[0] = (BYTE8)n;
|
|
||||||
n = send(simp->io_data, data, sizeof(data), 0);
|
|
||||||
switch (n) {
|
|
||||||
case 0:
|
|
||||||
closesocket(simp->io_data);
|
|
||||||
simp->io_data = INVALID_SOCKET;
|
|
||||||
chHDDAddFlagsI(sd, SD_DISCONNECTED);
|
|
||||||
return FALSE;
|
|
||||||
case SOCKET_ERROR:
|
|
||||||
if (WSAGetLastError() == WSAEWOULDBLOCK)
|
|
||||||
return FALSE;
|
|
||||||
closesocket(simp->io_data);
|
|
||||||
simp->io_data = INVALID_SOCKET;
|
|
||||||
return FALSE;
|
|
||||||
}
|
|
||||||
return TRUE;
|
|
||||||
}
|
|
||||||
return FALSE;
|
|
||||||
}
|
|
||||||
|
|
||||||
BOOL Iso1OutInterrupt(void) {
|
|
||||||
|
|
||||||
return outint("ISO1", &ISO1, &sim1);
|
|
||||||
}
|
|
||||||
Loading…
Reference in New Issue