LWWire: src/lwwire.c annotate

annotate src/lwwire.c @ 16:13be9d3a6927 default tip

update doc to include transactional delay requirement

author	Brett Gordon
date	Tue, 13 Dec 2016 10:42:01 -0500
parents	7702bb8a8216
children

rev	line source
0 bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	1 /*
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	2 This program implements the lwwire protocol. It expects STDIN and STDOUT
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	3 to be connected to an appropriately configured communication channel.
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	4
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	5 The following timeouts are specified by the protocol and are listed here
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	6 for convenience:
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	7
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	8 Between bytes in a request: 10 milliseconds
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	9 Between bytes reading a response (client): 10ms <= timeout <= 1000ms
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	10
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	11 Server receiving bad request: >= 1100 milliseconds
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	12
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	13 Implementation notes:
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	14
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	15 This implementation uses low level I/O calls (read()/write()) on STDIN
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	16 and STDOUT because we MUST have fully unbuffered I/O for the protocol
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	17 to function properly and we really do not want the stdio overhead for
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	18 that.
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	19
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	20 The complexity of the lwwire_readdata() and lwwire_writedata() functions
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	21 is required to handle some possible corner cases that would otherwise
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	22 completely bollix everything up.
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	23
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	24 Command line options:
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	25
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	26 drive=N,PATH
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	27
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	28 Specify that drive #N should reference the file at PATH. Note that the
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	29 file at PATH will be created if it doesn't exist, but only if it is actually
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	30 accessed. N is a decimal number from 0 to 255. If N is prefixed with "C",
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	31 the drive is treated as read-only.
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	32
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	33
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	34 By default, no drives are associated with files. Also, it is unspecified
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	35 what happens if multiple protocol instances access the same drive.
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	36
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	37 */
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	38
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	39 // for nanosleep
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	40 #define _POSIX_C_SOURCE 199309L
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	41
10 36c4cda4b6c4 Add extension support with the PINGPONG extension William Astle <lost@l-w.ca> parents: 9 diff changeset	42 #include <dlfcn.h>
0 bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	43 #include <errno.h>
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	44 #include <fcntl.h>
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	45 #include <stdio.h>
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	46 #include <stdlib.h>
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	47 #include <string.h>
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	48 #include <sys/select.h>
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	49 #include <time.h>
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	50 #include <unistd.h>
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	51
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	52 #define LWERR_NONE 0
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	53 #define LWERR_CHECKSUM 0xF3
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	54 #define LWERR_READ 0xF4
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	55 #define LWERR_WRITE 0xF5
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	56 #define LWERR_NOTREADY 0xF6
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	57
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	58 struct lwwire_driveinfo
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	59 {
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	60 char *path;
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	61 FILE *fp;
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	62 int isconst;
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	63 };
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	64
10 36c4cda4b6c4 Add extension support with the PINGPONG extension William Astle <lost@l-w.ca> parents: 9 diff changeset	65 struct lwwire_extension_data
36c4cda4b6c4 Add extension support with the PINGPONG extension William Astle <lost@l-w.ca> parents: 9 diff changeset	66 {
36c4cda4b6c4 Add extension support with the PINGPONG extension William Astle <lost@l-w.ca> parents: 9 diff changeset	67 int enabled;
36c4cda4b6c4 Add extension support with the PINGPONG extension William Astle <lost@l-w.ca> parents: 9 diff changeset	68 int (*handler)(int op); // handle op, return -1 if not supported
36c4cda4b6c4 Add extension support with the PINGPONG extension William Astle <lost@l-w.ca> parents: 9 diff changeset	69 int (*disable)(void); // disable extension negotiated
36c4cda4b6c4 Add extension support with the PINGPONG extension William Astle <lost@l-w.ca> parents: 9 diff changeset	70 int (*enable)(void); // enable extension negotiated (return -1 if failed to init)
36c4cda4b6c4 Add extension support with the PINGPONG extension William Astle <lost@l-w.ca> parents: 9 diff changeset	71 void (*reset)(void); // on server reset opcode; extension will be disabled automatically here
36c4cda4b6c4 Add extension support with the PINGPONG extension William Astle <lost@l-w.ca> parents: 9 diff changeset	72 };
36c4cda4b6c4 Add extension support with the PINGPONG extension William Astle <lost@l-w.ca> parents: 9 diff changeset	73
36c4cda4b6c4 Add extension support with the PINGPONG extension William Astle <lost@l-w.ca> parents: 9 diff changeset	74 struct lwwire_extension_data lwwire_extension_list[256];
36c4cda4b6c4 Add extension support with the PINGPONG extension William Astle <lost@l-w.ca> parents: 9 diff changeset	75
0 bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	76 struct lwwire_driveinfo drivedata[256];
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	77
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	78 void lwwire_protoerror(void);
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	79 int lwwire_readdata(void *, int, int);
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	80 int lwwire_writedata(void *, int);
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	81 void lwwire_write(void *, int);
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	82 int lwwire_read(void *, int);
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	83 int lwwire_read2(void *, int, int);
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	84 void lwwire_reset(void);
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	85 int lwwire_fetch_sector(int dn, int lsn, void *);
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	86 int lwwire_save_sector(int dn, int lsn, void *);
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	87 int nonblock(int);
2 2f2cbd2d2561 Theoretically make "C" flag for drive defs work. William Astle <lost@l-w.ca> parents: 0 diff changeset	88 int lwwire_drive_readononly(int dn);
10 36c4cda4b6c4 Add extension support with the PINGPONG extension William Astle <lost@l-w.ca> parents: 9 diff changeset	89 int lwwire_register_extension(int, int (handler)(int), int (enable)(void), int (disable)(void), void (reset)(void));
0 bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	90 void lwwire_proto_read(void);
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	91 void lwwire_proto_write(void);
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	92 void lwwire_proto_readex(void);
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	93 void lwwire_proto_requestextension(void);
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	94 void lwwire_proto_disableextension(void);
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	95 void lwwire_proto_extensionop(void);
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	96
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	97 int main(int argc, char **argv)
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	98 {
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	99 unsigned char buf[32];
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	100 time_t curtime;
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	101 struct tm *tmval;
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	102 int rv;
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	103 int i;
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	104
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	105 // make stdin and stdout non-blocking
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	106 if (nonblock(0) < 0)
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	107 {
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	108 fprintf(stderr, "Cannot make stdin non-blocking: %s\n", strerror(errno));
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	109 exit(1);
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	110 }
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	111 if (nonblock(1) < 0)
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	112 {
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	113 fprintf(stderr, "Cannot make stdout non-blocking: %s\n", strerror(errno));
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	114 exit(1);
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	115 }
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	116
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	117 memset(&drivedata, 0, sizeof(drivedata));
10 36c4cda4b6c4 Add extension support with the PINGPONG extension William Astle <lost@l-w.ca> parents: 9 diff changeset	118 memset(lwwire_extension_list, 0, sizeof(struct lwwire_extension_data) * 256);
0 bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	119
10 36c4cda4b6c4 Add extension support with the PINGPONG extension William Astle <lost@l-w.ca> parents: 9 diff changeset	120 // call lwwire_register_extension() for each extension you define
36c4cda4b6c4 Add extension support with the PINGPONG extension William Astle <lost@l-w.ca> parents: 9 diff changeset	121 // statically. Add those calls here, or calls to the equivalent
36c4cda4b6c4 Add extension support with the PINGPONG extension William Astle <lost@l-w.ca> parents: 9 diff changeset	122 // of the "lwwire_register" function from a DSO type extension.
36c4cda4b6c4 Add extension support with the PINGPONG extension William Astle <lost@l-w.ca> parents: 9 diff changeset	123
0 bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	124 for (i = 1; i < argc; i++)
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	125 {
10 36c4cda4b6c4 Add extension support with the PINGPONG extension William Astle <lost@l-w.ca> parents: 9 diff changeset	126 if (strncmp("ext=", argv[i], 4) == 0)
36c4cda4b6c4 Add extension support with the PINGPONG extension William Astle <lost@l-w.ca> parents: 9 diff changeset	127 {
36c4cda4b6c4 Add extension support with the PINGPONG extension William Astle <lost@l-w.ca> parents: 9 diff changeset	128 // SO name is at argv[i]+4
36c4cda4b6c4 Add extension support with the PINGPONG extension William Astle <lost@l-w.ca> parents: 9 diff changeset	129 void *dlhandle;
36c4cda4b6c4 Add extension support with the PINGPONG extension William Astle <lost@l-w.ca> parents: 9 diff changeset	130 void *initfn;
36c4cda4b6c4 Add extension support with the PINGPONG extension William Astle <lost@l-w.ca> parents: 9 diff changeset	131 int (*rinitfn)(void);
36c4cda4b6c4 Add extension support with the PINGPONG extension William Astle <lost@l-w.ca> parents: 9 diff changeset	132
36c4cda4b6c4 Add extension support with the PINGPONG extension William Astle <lost@l-w.ca> parents: 9 diff changeset	133 dlhandle = dlopen(argv[i] + 4, RTLD_NOW \| RTLD_LOCAL);
36c4cda4b6c4 Add extension support with the PINGPONG extension William Astle <lost@l-w.ca> parents: 9 diff changeset	134 if (!dlhandle)
36c4cda4b6c4 Add extension support with the PINGPONG extension William Astle <lost@l-w.ca> parents: 9 diff changeset	135 {
36c4cda4b6c4 Add extension support with the PINGPONG extension William Astle <lost@l-w.ca> parents: 9 diff changeset	136 fprintf(stderr, "Cannot load extension %s: %s\n", argv[i] + 4, dlerror());
36c4cda4b6c4 Add extension support with the PINGPONG extension William Astle <lost@l-w.ca> parents: 9 diff changeset	137 continue;
36c4cda4b6c4 Add extension support with the PINGPONG extension William Astle <lost@l-w.ca> parents: 9 diff changeset	138 }
36c4cda4b6c4 Add extension support with the PINGPONG extension William Astle <lost@l-w.ca> parents: 9 diff changeset	139 initfn = dlsym(dlhandle, "lwwire_register");
36c4cda4b6c4 Add extension support with the PINGPONG extension William Astle <lost@l-w.ca> parents: 9 diff changeset	140 if (!initfn)
36c4cda4b6c4 Add extension support with the PINGPONG extension William Astle <lost@l-w.ca> parents: 9 diff changeset	141 {
36c4cda4b6c4 Add extension support with the PINGPONG extension William Astle <lost@l-w.ca> parents: 9 diff changeset	142 dlclose(dlhandle);
36c4cda4b6c4 Add extension support with the PINGPONG extension William Astle <lost@l-w.ca> parents: 9 diff changeset	143 fprintf(stderr, "Extension '%s' is not valid.\n", argv[i] + 4);
36c4cda4b6c4 Add extension support with the PINGPONG extension William Astle <lost@l-w.ca> parents: 9 diff changeset	144 continue;
36c4cda4b6c4 Add extension support with the PINGPONG extension William Astle <lost@l-w.ca> parents: 9 diff changeset	145 }
36c4cda4b6c4 Add extension support with the PINGPONG extension William Astle <lost@l-w.ca> parents: 9 diff changeset	146 rinitfn = initfn;
36c4cda4b6c4 Add extension support with the PINGPONG extension William Astle <lost@l-w.ca> parents: 9 diff changeset	147 if ((*rinitfn)() != 0)
36c4cda4b6c4 Add extension support with the PINGPONG extension William Astle <lost@l-w.ca> parents: 9 diff changeset	148 {
36c4cda4b6c4 Add extension support with the PINGPONG extension William Astle <lost@l-w.ca> parents: 9 diff changeset	149 dlclose(dlhandle);
36c4cda4b6c4 Add extension support with the PINGPONG extension William Astle <lost@l-w.ca> parents: 9 diff changeset	150 fprintf(stderr, "Initialization of extension '%s' failed.\n", argv[i] + 4);
36c4cda4b6c4 Add extension support with the PINGPONG extension William Astle <lost@l-w.ca> parents: 9 diff changeset	151 continue;
36c4cda4b6c4 Add extension support with the PINGPONG extension William Astle <lost@l-w.ca> parents: 9 diff changeset	152 }
36c4cda4b6c4 Add extension support with the PINGPONG extension William Astle <lost@l-w.ca> parents: 9 diff changeset	153 }
36c4cda4b6c4 Add extension support with the PINGPONG extension William Astle <lost@l-w.ca> parents: 9 diff changeset	154 else if (strncmp("drive=", argv[i], 6) == 0)
0 bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	155 {
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	156 int dn=0;
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	157 int isconst = 0;
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	158 char *ptr;
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	159 ptr = argv[i] + 6;
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	160 if (*ptr == 'C')
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	161 {
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	162 isconst = 1;
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	163 ptr++;
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	164 }
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	165 while (ptr >= '0' && ptr <= '9')
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	166 {
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	167 dn = dn * 10 + (*ptr - '0');
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	168 ptr++;
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	169 }
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	170 if (*ptr != ',' \|\| dn > 255)
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	171 {
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	172 fprintf(stderr, "Ignoring invalid drive specification: %s\n", argv[i]);
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	173 continue;
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	174 }
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	175 ptr++;
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	176 drivedata[dn].path = ptr;
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	177 drivedata[dn].isconst = isconst;
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	178 }
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	179 }
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	180
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	181 fprintf(stderr, "Running with the following disk images:\n");
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	182 for (i = 0; i < 256; i++)
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	183 {
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	184 if (drivedata[i].path)
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	185 {
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	186 fprintf(stderr, "[%d%s] %s\n", i, drivedata[i].isconst ? "C" : "", drivedata[i].path);
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	187 }
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	188 }
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	189
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	190 // main loop reading operations and dispatching
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	191 for (;;)
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	192 {
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	193 rv = lwwire_readdata(buf, 1, 0);
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	194 if (rv < 0)
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	195 {
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	196 fprintf(stderr, "Error or timeout reading operation code.\n");
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	197 lwwire_protoerror();
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	198 continue;
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	199 }
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	200 if (rv == 0)
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	201 {
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	202 fprintf(stderr, "EOF on comm channel. Exiting.\n");
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	203 exit(0);
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	204 }
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	205 fprintf(stderr, "Handling opcode %02X\n", buf[0]);
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	206
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	207 // we have an opcode here
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	208 switch (buf[0])
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	209 {
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	210 case 0x00: // NOOP
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	211 break;
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	212
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	213 case 0x23: // TIME
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	214 curtime = time(NULL);
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	215 tmval = localtime(&curtime);
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	216 buf[0] = tmval -> tm_year;
11 38184ef1296d Make TIME call agree with spec William Astle <lost@l-w.ca> parents: 10 diff changeset	217 buf[1] = tmval -> tm_mon + 1; // spec wants 1-12; localtime() gives 0-11
0 bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	218 buf[2] = tmval -> tm_mday;
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	219 buf[3] = tmval -> tm_hour;
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	220 buf[4] = tmval -> tm_min;
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	221 buf[5] = tmval -> tm_sec;
8 cf915ece9e48 Remove "week day" from the TIME response William Astle <lost@l-w.ca> parents: 5 diff changeset	222 lwwire_write(buf, 6);
0 bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	223 break;
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	224
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	225 case 0x46: // PRINTFLUSH
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	226 // no printer is supported by this implemention so NO-OP
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	227 break;
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	228
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	229 case 0x47: // GETSTAT (useless dw3 operation)
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	230 case 0x53: // SETSTAT (useless dw3 operation)
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	231 // burn two bytes from the client and do nothing
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	232 lwwire_read(buf, 2);
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	233 break;
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	234
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	235 case 0x49: // INIT (old style INIT call)
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	236 case 0x54: // TERM (old DW3 op treated same as INIT)
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	237 case 0xF8: // RESET3 (junk on the line during reset)
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	238 case 0xFE: // RESET1 (junk on the line during reset)
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	239 case 0xFF: // RESET2 (junk on the line during reset)
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	240 lwwire_reset();
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	241 break;
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	242
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	243 case 0x50: // PRINT
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	244 // burn a byte because we don't support any printers
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	245 lwwire_read(buf, 1);
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	246 break;
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	247
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	248 case 0x52: // READ
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	249 case 0x72: // REREAD (same semantics as READ)
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	250 fprintf(stderr, "DWPROTO: read()\n");
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	251 lwwire_proto_read();
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	252 break;
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	253
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	254 case 0x57: // WRITE
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	255 case 0x77: // REWRITE (same semantics as WRITE)
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	256 fprintf(stderr, "DWPROTO: write()\n");
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	257 lwwire_proto_write();
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	258 break;
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	259
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	260 case 0x5A: // DWINIT (new style init)
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	261 lwwire_reset();
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	262 if (lwwire_read(buf, 1) < 0)
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	263 break;
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	264 fprintf(stderr, "DWINIT: client drive code %02X\n", buf[0]);
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	265 // tell the client we speak lwwire protocol
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	266 buf[0] = 0x80;
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	267 lwwire_write(buf, 1);
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	268 break;
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	269
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	270 case 0xD2: // READEX (improved reading operation)
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	271 case 0xF2: // REREADEX (same semantics as READEX)
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	272 fprintf(stderr, "DWPROTO: readex()\n");
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	273 lwwire_proto_readex();
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	274 break;
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	275
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	276 case 0xF0: // REQUESTEXTENSION
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	277 lwwire_proto_requestextension();
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	278 break;
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	279
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	280 case 0xF1: // DISABLEEXTENSION
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	281 lwwire_proto_disableextension();
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	282 break;
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	283
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	284 case 0xF3: // EXTENSIONOP
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	285 lwwire_proto_extensionop();
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	286 break;
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	287
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	288 default:
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	289 fprintf(stderr, "Unrecognized operation code %02X. Doing error state.\n", buf[0]);
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	290 lwwire_protoerror();
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	291 break;
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	292 }
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	293 }
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	294 }
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	295
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	296 // protocol handling functions
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	297 void lwwire_proto_read(void)
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	298 {
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	299 unsigned char buf[259];
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	300 int ec;
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	301 int lsn;
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	302 int i;
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	303
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	304 if (lwwire_read(buf, 4) < 0)
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	305 return;
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	306
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	307 lsn = (buf[1] << 16) \| (buf[2] << 8) \| buf[3];
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	308
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	309 ec = lwwire_fetch_sector(buf[0], lsn, buf + 1);
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	310 buf[0] = ec;
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	311 lwwire_write(buf, 1);
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	312 if (ec)
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	313 return;
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	314 // all this futzing around here is probably a long enough
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	315 // delay but testing on real hardware is needed here
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	316 ec = 0;
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	317 for (i = 1; i < 257; i++)
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	318 ec += buf[i];
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	319 buf[257] = (ec >> 8) & 0xff;
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	320 buf[258] = ec & 0xff;
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	321 lwwire_write(buf + 1, 258);
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	322 }
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	323
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	324 void lwwire_proto_write(void)
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	325 {
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	326 unsigned char buf[262];
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	327 int lsn;
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	328 int ec;
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	329 int i;
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	330 if (lwwire_read(buf, 262) < 0)
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	331 return;
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	332
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	333 lsn = (buf[1] << 16) \| (buf[2] << 8) \| buf[3];
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	334 for (ec = 0, i = 4; i < 260; i++)
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	335 ec += buf[i];
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	336 if (ec != ((buf[260] << 8) \| buf[261]))
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	337 {
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	338 buf[0] = LWERR_CHECKSUM;
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	339 }
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	340 else
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	341 {
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	342 ec = lwwire_save_sector(buf[0], lsn, buf + 4);
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	343 buf[0] = ec;
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	344 }
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	345 lwwire_write(buf, 1);
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	346 }
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	347
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	348 void lwwire_proto_readex(void)
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	349 {
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	350 unsigned char buf[256];
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	351 int lsn;
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	352 int ec;
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	353 int i;
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	354 int csum;
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	355 if (lwwire_read(buf, 4) < 0)
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	356 return;
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	357 lsn = (buf[1] << 16) \| (buf[2] << 8) \| buf[3];
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	358 ec = lwwire_fetch_sector(buf[0], lsn, buf);
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	359 if (ec)
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	360 memset(buf, 0, 256);
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	361 for (i = 0, csum = 0; i < 256; i++)
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	362 csum += buf[i];
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	363 lwwire_write(buf, 256);
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	364 if ((i = lwwire_read2(buf, 2, 5)) < 0)
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	365 {
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	366 fprintf(stderr, "Error reading protocol bytes: %d, %s\n", i, strerror(errno));
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	367 return;
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	368 }
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	369 i = (buf[0] << 8) \| buf[1];
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	370 if (i != csum)
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	371 ec = LWERR_CHECKSUM;
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	372 buf[0] = ec;
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	373 lwwire_write(buf, 1);
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	374 }
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	375
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	376 void lwwire_proto_requestextension(void)
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	377 {
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	378 unsigned char buf[1];
10 36c4cda4b6c4 Add extension support with the PINGPONG extension William Astle <lost@l-w.ca> parents: 9 diff changeset	379 int ext;
36c4cda4b6c4 Add extension support with the PINGPONG extension William Astle <lost@l-w.ca> parents: 9 diff changeset	380
0 bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	381 if (lwwire_read(buf, 1) < 0)
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	382 return;
10 36c4cda4b6c4 Add extension support with the PINGPONG extension William Astle <lost@l-w.ca> parents: 9 diff changeset	383 ext = buf[0];
36c4cda4b6c4 Add extension support with the PINGPONG extension William Astle <lost@l-w.ca> parents: 9 diff changeset	384 buf[0] = 0x55; // default to NAK
36c4cda4b6c4 Add extension support with the PINGPONG extension William Astle <lost@l-w.ca> parents: 9 diff changeset	385 if (lwwire_extension_list[ext].enable)
36c4cda4b6c4 Add extension support with the PINGPONG extension William Astle <lost@l-w.ca> parents: 9 diff changeset	386 {
36c4cda4b6c4 Add extension support with the PINGPONG extension William Astle <lost@l-w.ca> parents: 9 diff changeset	387 if ((*(lwwire_extension_list[ext].enable))() == 0)
36c4cda4b6c4 Add extension support with the PINGPONG extension William Astle <lost@l-w.ca> parents: 9 diff changeset	388 {
36c4cda4b6c4 Add extension support with the PINGPONG extension William Astle <lost@l-w.ca> parents: 9 diff changeset	389 // enable succeeded; enable it
36c4cda4b6c4 Add extension support with the PINGPONG extension William Astle <lost@l-w.ca> parents: 9 diff changeset	390 buf[0] = 0x42;
36c4cda4b6c4 Add extension support with the PINGPONG extension William Astle <lost@l-w.ca> parents: 9 diff changeset	391 lwwire_extension_list[ext].enabled = 1;
36c4cda4b6c4 Add extension support with the PINGPONG extension William Astle <lost@l-w.ca> parents: 9 diff changeset	392 }
36c4cda4b6c4 Add extension support with the PINGPONG extension William Astle <lost@l-w.ca> parents: 9 diff changeset	393 }
0 bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	394 lwwire_write(buf, 1);
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	395 }
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	396
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	397 void lwwire_proto_disableextension(void)
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	398 {
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	399 unsigned char buf[1];
10 36c4cda4b6c4 Add extension support with the PINGPONG extension William Astle <lost@l-w.ca> parents: 9 diff changeset	400 int ext;
0 bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	401
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	402 if (lwwire_read(buf, 1) < 0)
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	403 return;
10 36c4cda4b6c4 Add extension support with the PINGPONG extension William Astle <lost@l-w.ca> parents: 9 diff changeset	404 ext = buf[0];
36c4cda4b6c4 Add extension support with the PINGPONG extension William Astle <lost@l-w.ca> parents: 9 diff changeset	405
36c4cda4b6c4 Add extension support with the PINGPONG extension William Astle <lost@l-w.ca> parents: 9 diff changeset	406 buf[0] = 0x42; // default to ACK
36c4cda4b6c4 Add extension support with the PINGPONG extension William Astle <lost@l-w.ca> parents: 9 diff changeset	407 if (lwwire_extension_list[ext].disable)
36c4cda4b6c4 Add extension support with the PINGPONG extension William Astle <lost@l-w.ca> parents: 9 diff changeset	408 {
36c4cda4b6c4 Add extension support with the PINGPONG extension William Astle <lost@l-w.ca> parents: 9 diff changeset	409 if ((*(lwwire_extension_list[ext].disable))() != 0)
36c4cda4b6c4 Add extension support with the PINGPONG extension William Astle <lost@l-w.ca> parents: 9 diff changeset	410 {
36c4cda4b6c4 Add extension support with the PINGPONG extension William Astle <lost@l-w.ca> parents: 9 diff changeset	411 // extension says it can't be disabled; NAK response
36c4cda4b6c4 Add extension support with the PINGPONG extension William Astle <lost@l-w.ca> parents: 9 diff changeset	412 buf[0] = 0x55;
36c4cda4b6c4 Add extension support with the PINGPONG extension William Astle <lost@l-w.ca> parents: 9 diff changeset	413 }
36c4cda4b6c4 Add extension support with the PINGPONG extension William Astle <lost@l-w.ca> parents: 9 diff changeset	414 }
36c4cda4b6c4 Add extension support with the PINGPONG extension William Astle <lost@l-w.ca> parents: 9 diff changeset	415 if (buf[0] == 0x42)
36c4cda4b6c4 Add extension support with the PINGPONG extension William Astle <lost@l-w.ca> parents: 9 diff changeset	416 lwwire_extension_list[ext].enabled = 0;
0 bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	417 lwwire_write(buf, 1);
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	418 }
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	419
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	420 void lwwire_proto_extensionop(void)
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	421 {
10 36c4cda4b6c4 Add extension support with the PINGPONG extension William Astle <lost@l-w.ca> parents: 9 diff changeset	422 unsigned char buf[2];
36c4cda4b6c4 Add extension support with the PINGPONG extension William Astle <lost@l-w.ca> parents: 9 diff changeset	423 int ext;
36c4cda4b6c4 Add extension support with the PINGPONG extension William Astle <lost@l-w.ca> parents: 9 diff changeset	424 int op;
36c4cda4b6c4 Add extension support with the PINGPONG extension William Astle <lost@l-w.ca> parents: 9 diff changeset	425
36c4cda4b6c4 Add extension support with the PINGPONG extension William Astle <lost@l-w.ca> parents: 9 diff changeset	426 if (lwwire_read(buf, 2) < 0)
0 bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	427 return;
10 36c4cda4b6c4 Add extension support with the PINGPONG extension William Astle <lost@l-w.ca> parents: 9 diff changeset	428 ext = buf[0];
36c4cda4b6c4 Add extension support with the PINGPONG extension William Astle <lost@l-w.ca> parents: 9 diff changeset	429 op = buf[1];
36c4cda4b6c4 Add extension support with the PINGPONG extension William Astle <lost@l-w.ca> parents: 9 diff changeset	430 if (lwwire_extension_list[ext].enabled == 1)
36c4cda4b6c4 Add extension support with the PINGPONG extension William Astle <lost@l-w.ca> parents: 9 diff changeset	431 {
36c4cda4b6c4 Add extension support with the PINGPONG extension William Astle <lost@l-w.ca> parents: 9 diff changeset	432 if (lwwire_extension_list[ext].handler)
36c4cda4b6c4 Add extension support with the PINGPONG extension William Astle <lost@l-w.ca> parents: 9 diff changeset	433 {
36c4cda4b6c4 Add extension support with the PINGPONG extension William Astle <lost@l-w.ca> parents: 9 diff changeset	434 if ((*(lwwire_extension_list[ext].handler))(op) == 0)
36c4cda4b6c4 Add extension support with the PINGPONG extension William Astle <lost@l-w.ca> parents: 9 diff changeset	435 return;
36c4cda4b6c4 Add extension support with the PINGPONG extension William Astle <lost@l-w.ca> parents: 9 diff changeset	436 }
36c4cda4b6c4 Add extension support with the PINGPONG extension William Astle <lost@l-w.ca> parents: 9 diff changeset	437 lwwire_protoerror();
36c4cda4b6c4 Add extension support with the PINGPONG extension William Astle <lost@l-w.ca> parents: 9 diff changeset	438 return;
36c4cda4b6c4 Add extension support with the PINGPONG extension William Astle <lost@l-w.ca> parents: 9 diff changeset	439 }
36c4cda4b6c4 Add extension support with the PINGPONG extension William Astle <lost@l-w.ca> parents: 9 diff changeset	440 // extension not enabled; do a protocol error
0 bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	441 lwwire_protoerror();
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	442 }
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	443
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	444 // Various infrastructure things follow here.
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	445 int nonblock(int fd)
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	446 {
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	447 int flags;
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	448
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	449 flags = fcntl(fd, F_GETFL);
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	450 if (flags < 0)
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	451 return -1;
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	452 flags \|= O_NONBLOCK;
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	453 return fcntl(fd, F_SETFL, flags);
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	454 }
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	455
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	456 /*
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	457 Read len bytes from the input. If no bytes are available after
5 422f5e8fff85 Extend base read timeout to 100ms in spec and implementation. William Astle <lost@l-w.ca> parents: 4 diff changeset	458 100 ms, return error.
0 bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	459
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	460 This may allow a timeout longer than 10ms. However, it will
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	461 eventually time out. In the worse case, it is more permissive
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	462 than the specification. It will not time out before 10ms elapses.
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	463
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	464 If "itimeout" is 0, then it will wait forever for the first
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	465 byte. Otherwise, it will time out even on the first one.
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	466
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	467 */
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	468 int lwwire_readdata(void *buf, int len, int itimeout)
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	469 {
9 a11b330771e0 Fix buffer pointer handling when logging received bytes William Astle <lost@l-w.ca> parents: 8 diff changeset	470 char *obuf = buf;
0 bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	471 int toread = len;
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	472 int rv;
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	473 fd_set fdset;
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	474 struct timeval timeout;
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	475
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	476 if (itimeout == 0)
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	477 {
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	478 for (;;)
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	479 {
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	480 // now wait for the descriptor to be readable
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	481 FD_ZERO(&fdset);
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	482 FD_SET(0, &fdset);
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	483
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	484 rv = select(1, &fdset, NULL, NULL, NULL);
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	485 if (rv < 0)
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	486 {
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	487 // this is a last ditch effort to not break completely
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	488 // in the face of a signal; it should occur only rarely
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	489 // and it is not clear what the correct behaviour should
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	490 // be.
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	491 if (errno == EINTR)
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	492 continue;
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	493 return -1;
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	494 }
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	495 // if we actually have something to read, move on
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	496 if (rv > 0)
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	497 break;
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	498 }
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	499 }
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	500 while (toread > 0)
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	501 {
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	502 rv = read(0, buf, toread);
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	503 if (rv == toread)
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	504 break;
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	505 if (rv == 0)
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	506 {
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	507 // flag EOF so the caller knows to bail
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	508 return 0;
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	509 }
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	510 if (rv < 0)
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	511 {
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	512 if (errno != EAGAIN && errno != EWOULDBLOCK && errno != EINTR)
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	513 {
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	514 return -1;
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	515 }
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	516 rv = 0;
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	517 }
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	518 // now rv is the number of bytes read
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	519 buf += rv;
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	520 toread -= rv;
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	521
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	522 // now wait for the descriptor to be readable
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	523 FD_ZERO(&fdset);
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	524 FD_SET(0, &fdset);
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	525 timeout.tv_sec = 0;
5 422f5e8fff85 Extend base read timeout to 100ms in spec and implementation. William Astle <lost@l-w.ca> parents: 4 diff changeset	526 timeout.tv_usec = 100000 * itimeout;
0 bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	527
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	528 rv = select(1, &fdset, NULL, NULL, &timeout);
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	529 if (rv < 0)
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	530 {
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	531 // this is a last ditch effort to not break completely
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	532 // in the face of a signal; it should occur only rarely
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	533 // and it is not clear what the correct behaviour should
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	534 // be.
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	535 if (errno == EINTR)
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	536 continue;
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	537 return -1;
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	538 }
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	539 // timeout condition
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	540 if (rv == 0)
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	541 {
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	542 errno = ETIMEDOUT;
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	543 return -1;
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	544 }
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	545 // anything else here means we have more bytes to read
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	546 }
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	547 fprintf(stderr, "Protocol bytes read (%d):", len);
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	548 for (rv = 0; rv < len; rv++)
9 a11b330771e0 Fix buffer pointer handling when logging received bytes William Astle <lost@l-w.ca> parents: 8 diff changeset	549 fprintf(stderr, " %02X ", (obuf[rv]) & 0xff);
0 bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	550 fprintf(stderr, "\n");
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	551 return len;
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	552 }
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	553
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	554 /*
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	555 Write data to the output. This will time out after 10 seconds. The timeout
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	556 is only there in case the underlying communication channel goes out to lunch.
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	557
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	558 It returns -1 on error or len on success.
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	559
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	560 The timeout requires the file descriptor to be non-blocking.
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	561
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	562 */
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	563 int lwwire_writedata(void *buf, int len)
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	564 {
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	565 int towrite = len;
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	566 int rv;
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	567 fd_set fdset;
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	568 struct timeval timeout;
13 7702bb8a8216 Add transactional delay in lwwire_write() Brett Gordon parents: 11 diff changeset	569 struct timespec sltime;
7702bb8a8216 Add transactional delay in lwwire_write() Brett Gordon parents: 11 diff changeset	570 struct timespec rtime;
7702bb8a8216 Add transactional delay in lwwire_write() Brett Gordon parents: 11 diff changeset	571
7702bb8a8216 Add transactional delay in lwwire_write() Brett Gordon parents: 11 diff changeset	572
7702bb8a8216 Add transactional delay in lwwire_write() Brett Gordon parents: 11 diff changeset	573 // Sleep for 50us to client has time to start
7702bb8a8216 Add transactional delay in lwwire_write() Brett Gordon parents: 11 diff changeset	574 // listening
7702bb8a8216 Add transactional delay in lwwire_write() Brett Gordon parents: 11 diff changeset	575 sltime.tv_sec = 0;
7702bb8a8216 Add transactional delay in lwwire_write() Brett Gordon parents: 11 diff changeset	576 sltime.tv_nsec = 50000;
7702bb8a8216 Add transactional delay in lwwire_write() Brett Gordon parents: 11 diff changeset	577 while (nanosleep(&sltime, &rtime) < 0)
7702bb8a8216 Add transactional delay in lwwire_write() Brett Gordon parents: 11 diff changeset	578 {
7702bb8a8216 Add transactional delay in lwwire_write() Brett Gordon parents: 11 diff changeset	579 // anything other than EINTR indicates something seriously messed up
7702bb8a8216 Add transactional delay in lwwire_write() Brett Gordon parents: 11 diff changeset	580 if (errno != EINTR)
7702bb8a8216 Add transactional delay in lwwire_write() Brett Gordon parents: 11 diff changeset	581 return -1;
7702bb8a8216 Add transactional delay in lwwire_write() Brett Gordon parents: 11 diff changeset	582 sltime = rtime;
7702bb8a8216 Add transactional delay in lwwire_write() Brett Gordon parents: 11 diff changeset	583 }
7702bb8a8216 Add transactional delay in lwwire_write() Brett Gordon parents: 11 diff changeset	584
7702bb8a8216 Add transactional delay in lwwire_write() Brett Gordon parents: 11 diff changeset	585
0 bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	586 while (towrite > 0)
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	587 {
3 e94940ca17e7 Write to stdout not stdin. Duh! William Astle <lost@l-w.ca> parents: 2 diff changeset	588 rv = write(1, buf, towrite);
0 bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	589 if (rv == towrite)
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	590 break;
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	591 if (rv < 0)
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	592 {
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	593 if (errno != EAGAIN && errno != EWOULDBLOCK && errno != EINTR)
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	594 {
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	595 return -1;
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	596 }
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	597 rv = 0;
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	598 }
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	599 // now rv is the number of bytes read
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	600 buf += rv;
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	601 towrite -= rv;
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	602
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	603 // now wait for the descriptor to be writable
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	604 FD_ZERO(&fdset);
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	605 FD_SET(1, &fdset);
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	606 timeout.tv_sec = 10;
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	607 timeout.tv_usec = 0;
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	608
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	609 rv = select(2, NULL, &fdset, NULL, &timeout);
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	610 if (rv < 0)
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	611 {
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	612 // this is a last ditch effort to not break completely
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	613 // in the face of a signal; it should occur only rarely
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	614 // and it is not clear what the correct behaviour should
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	615 // be.
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	616 if (errno == EINTR)
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	617 continue;
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	618 return -1;
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	619 }
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	620 // timeout condition
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	621 if (rv == 0)
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	622 {
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	623 errno = ETIMEDOUT;
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	624 return -1;
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	625 }
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	626 // anything else here means we have more bytes to write
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	627 }
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	628 fprintf(stderr, "Protocol bytes written (%d):", len);
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	629 for (rv = 0; rv < len; rv++)
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	630 fprintf(stderr, " %02X ", ((char *)(buf))[rv] & 0xff);
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	631 fprintf(stderr, "\n");
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	632 return len;
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	633 }
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	634
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	635 // like lwwire_writedata() except it bails the program on error.
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	636 void lwwire_write(void *buf, int len)
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	637 {
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	638 if (lwwire_writedata(buf, len) < 0)
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	639 {
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	640 fprintf(stderr, "Error writing %d bytes to client: %s\n", len, strerror(errno));
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	641 exit(1);
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	642 }
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	643 }
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	644
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	645 // like lwwire_readdata() except it bails on EOF and bounces to
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	646 // error state on errors, and always does the timeout for initial
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	647 // bytes. It returns -1 on a timeout. It does not return on EOF.
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	648 // It does not return on random errors.
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	649 int lwwire_read2(void *buf, int len, int toscale)
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	650 {
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	651 int rv;
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	652 rv = lwwire_readdata(buf, len, toscale);
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	653 if (rv < 0)
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	654 {
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	655 if (errno == ETIMEDOUT)
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	656 {
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	657 lwwire_protoerror();
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	658 return -1;
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	659 }
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	660 fprintf(stderr, "Error reading %d bytes from client: %s\n", len, strerror(errno));
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	661 exit(1);
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	662 }
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	663 if (rv == 0)
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	664 {
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	665 fprintf(stderr, "EOF reading %d bytes from client.", len);
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	666 exit(0);
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	667 }
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	668 return 0;
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	669 }
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	670
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	671 int lwwire_read(void *buf, int len)
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	672 {
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	673 return lwwire_read2(buf, len, 1);
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	674 }
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	675
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	676 /*
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	677 Handle a protocol error by maintaining radio silence for
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	678 at least 1100 ms. The pause must be at least 1100ms so
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	679 it's no problem if the messing about takes longer. Do a
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	680 state reset after the error.
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	681 */
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	682 void lwwire_protoerror(void)
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	683 {
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	684 struct timespec sltime;
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	685 struct timespec rtime;
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	686
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	687 sltime.tv_sec = 1;
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	688 sltime.tv_nsec = 100000000;
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	689
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	690 while (nanosleep(&sltime, &rtime) < 0)
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	691 {
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	692 // anything other than EINTR indicates something seriously messed up
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	693 if (errno != EINTR)
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	694 break;
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	695 sltime = rtime;
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	696 }
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	697 lwwire_reset();
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	698 }
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	699
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	700 /* fetch a file pointer for the specified drive number */
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	701 FILE *lwwire_fetch_drive_fp(int dn)
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	702 {
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	703 if (drivedata[dn].path == NULL)
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	704 return NULL;
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	705 if (drivedata[dn].fp)
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	706 {
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	707 if (ferror(drivedata[dn].fp))
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	708 fclose(drivedata[dn].fp);
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	709 else
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	710 return drivedata[dn].fp;
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	711 }
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	712
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	713 drivedata[dn].fp = fopen(drivedata[dn].path, "r+");
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	714 if (!drivedata[dn].fp)
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	715 {
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	716 if (errno == ENOENT && !drivedata[dn].isconst)
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	717 {
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	718 drivedata[dn].fp = fopen(drivedata[dn].path, "w+");
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	719 }
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	720 }
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	721 return drivedata[dn].fp;
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	722 }
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	723
2 2f2cbd2d2561 Theoretically make "C" flag for drive defs work. William Astle <lost@l-w.ca> parents: 0 diff changeset	724 int lwwire_drive_readonly(int dn)
2f2cbd2d2561 Theoretically make "C" flag for drive defs work. William Astle <lost@l-w.ca> parents: 0 diff changeset	725 {
2f2cbd2d2561 Theoretically make "C" flag for drive defs work. William Astle <lost@l-w.ca> parents: 0 diff changeset	726 return drivedata[dn].isconst;
2f2cbd2d2561 Theoretically make "C" flag for drive defs work. William Astle <lost@l-w.ca> parents: 0 diff changeset	727 }
2f2cbd2d2561 Theoretically make "C" flag for drive defs work. William Astle <lost@l-w.ca> parents: 0 diff changeset	728
2f2cbd2d2561 Theoretically make "C" flag for drive defs work. William Astle <lost@l-w.ca> parents: 0 diff changeset	729
0 bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	730 /* read a sector from a disk image */
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	731 int lwwire_fetch_sector(int dn, int lsn, void *buf)
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	732 {
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	733 FILE *fp;
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	734 int rc;
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	735
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	736 fp = lwwire_fetch_drive_fp(dn);
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	737 if (!fp)
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	738 return LWERR_NOTREADY;
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	739
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	740 if (fseek(fp, lsn * 256, SEEK_SET) < 0)
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	741 return LWERR_READ;
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	742 rc = fread(buf, 1, 256, fp);
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	743 if (rc < 256)
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	744 {
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	745 memset(buf + rc, 0, 256 - rc);
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	746 }
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	747 return 0;
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	748 }
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	749
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	750 int lwwire_save_sector(int dn, int lsn, void *buf)
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	751 {
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	752 FILE *fp;
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	753 int rc;
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	754
2 2f2cbd2d2561 Theoretically make "C" flag for drive defs work. William Astle <lost@l-w.ca> parents: 0 diff changeset	755 if (lwwire_drive_readonly(dn))
2f2cbd2d2561 Theoretically make "C" flag for drive defs work. William Astle <lost@l-w.ca> parents: 0 diff changeset	756 return LWERR_WRITE;
0 bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	757 fp = lwwire_fetch_drive_fp(dn);
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	758 if (!fp)
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	759 return LWERR_NOTREADY;
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	760 if (drivedata[dn].isconst)
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	761 return LWERR_WRITE;
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	762 if (fseek(fp, lsn * 256, SEEK_SET) < 0)
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	763 return LWERR_WRITE;
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	764 rc = fwrite(buf, 1, 256, fp);
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	765 if (rc < 256)
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	766 return LWERR_WRITE;
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	767 return 0;
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	768 }
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	769
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	770
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	771 /*
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	772 Reset the protocol state to "base protocol" mode.
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	773 */
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	774 void lwwire_reset(void)
bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	775 {
10 36c4cda4b6c4 Add extension support with the PINGPONG extension William Astle <lost@l-w.ca> parents: 9 diff changeset	776 int i;
36c4cda4b6c4 Add extension support with the PINGPONG extension William Astle <lost@l-w.ca> parents: 9 diff changeset	777
36c4cda4b6c4 Add extension support with the PINGPONG extension William Astle <lost@l-w.ca> parents: 9 diff changeset	778 // tell all extensions to reset and disable them
36c4cda4b6c4 Add extension support with the PINGPONG extension William Astle <lost@l-w.ca> parents: 9 diff changeset	779 for (i = 0; i < 256; i++)
36c4cda4b6c4 Add extension support with the PINGPONG extension William Astle <lost@l-w.ca> parents: 9 diff changeset	780 {
36c4cda4b6c4 Add extension support with the PINGPONG extension William Astle <lost@l-w.ca> parents: 9 diff changeset	781 if (lwwire_extension_list[i].handler)
36c4cda4b6c4 Add extension support with the PINGPONG extension William Astle <lost@l-w.ca> parents: 9 diff changeset	782 {
36c4cda4b6c4 Add extension support with the PINGPONG extension William Astle <lost@l-w.ca> parents: 9 diff changeset	783 (*(lwwire_extension_list[i].reset))();
36c4cda4b6c4 Add extension support with the PINGPONG extension William Astle <lost@l-w.ca> parents: 9 diff changeset	784 }
36c4cda4b6c4 Add extension support with the PINGPONG extension William Astle <lost@l-w.ca> parents: 9 diff changeset	785 lwwire_extension_list[i].enabled = 0;
36c4cda4b6c4 Add extension support with the PINGPONG extension William Astle <lost@l-w.ca> parents: 9 diff changeset	786 }
0 bef2801ac83e Initial checkin with reference implementation of core protocol William Astle <lost@l-w.ca> parents: diff changeset	787 }
10 36c4cda4b6c4 Add extension support with the PINGPONG extension William Astle <lost@l-w.ca> parents: 9 diff changeset	788
36c4cda4b6c4 Add extension support with the PINGPONG extension William Astle <lost@l-w.ca> parents: 9 diff changeset	789 /*
36c4cda4b6c4 Add extension support with the PINGPONG extension William Astle <lost@l-w.ca> parents: 9 diff changeset	790 Register an extension. This will replace the registration if the same
36c4cda4b6c4 Add extension support with the PINGPONG extension William Astle <lost@l-w.ca> parents: 9 diff changeset	791 extension number is registered twice. Returns -1 on parameter error.
36c4cda4b6c4 Add extension support with the PINGPONG extension William Astle <lost@l-w.ca> parents: 9 diff changeset	792 ALL function arguments are required. num must be between 0 and 255 inclusive
36c4cda4b6c4 Add extension support with the PINGPONG extension William Astle <lost@l-w.ca> parents: 9 diff changeset	793 currently. Returns 0 if the extension is registered.
36c4cda4b6c4 Add extension support with the PINGPONG extension William Astle <lost@l-w.ca> parents: 9 diff changeset	794 */
36c4cda4b6c4 Add extension support with the PINGPONG extension William Astle <lost@l-w.ca> parents: 9 diff changeset	795 int lwwire_register_extension(int num, int (handler)(int), int (enable)(void), int (disable)(void), void (reset)(void))
36c4cda4b6c4 Add extension support with the PINGPONG extension William Astle <lost@l-w.ca> parents: 9 diff changeset	796 {
36c4cda4b6c4 Add extension support with the PINGPONG extension William Astle <lost@l-w.ca> parents: 9 diff changeset	797 if (!handler \|\| !enable \|\| !disable \|\| !reset)
36c4cda4b6c4 Add extension support with the PINGPONG extension William Astle <lost@l-w.ca> parents: 9 diff changeset	798 return -1;
36c4cda4b6c4 Add extension support with the PINGPONG extension William Astle <lost@l-w.ca> parents: 9 diff changeset	799 if (num < 0 \|\| num > 255)
36c4cda4b6c4 Add extension support with the PINGPONG extension William Astle <lost@l-w.ca> parents: 9 diff changeset	800 return -1;
36c4cda4b6c4 Add extension support with the PINGPONG extension William Astle <lost@l-w.ca> parents: 9 diff changeset	801 lwwire_extension_list[num].handler = handler;
36c4cda4b6c4 Add extension support with the PINGPONG extension William Astle <lost@l-w.ca> parents: 9 diff changeset	802 lwwire_extension_list[num].enable = enable;
36c4cda4b6c4 Add extension support with the PINGPONG extension William Astle <lost@l-w.ca> parents: 9 diff changeset	803 lwwire_extension_list[num].disable = disable;
36c4cda4b6c4 Add extension support with the PINGPONG extension William Astle <lost@l-w.ca> parents: 9 diff changeset	804 lwwire_extension_list[num].reset = reset;
36c4cda4b6c4 Add extension support with the PINGPONG extension William Astle <lost@l-w.ca> parents: 9 diff changeset	805 return 0;
36c4cda4b6c4 Add extension support with the PINGPONG extension William Astle <lost@l-w.ca> parents: 9 diff changeset	806 }

Mercurial > hg > index.cgi

annotate src/lwwire.c @ 16:13be9d3a6927 default tip