fix off by .5 errors in ogl_upixelc and ogl_ulinec (d1x r1.29)
[btb/d2x.git] / arch / dos / comm / dzcomm.c
1 /*
2  * DZcomm : serial communication add-on for Allegro.
3  * version : 0.6
4  * Copyright (c) 1997 Dim Zegebart, Moscow Russia.
5  * zager@post.comstar.ru
6  * file : dzcomm.c
7  *
8  */
9
10 #include <stdio.h>
11 #include <sys/movedata.h>
12 #include <stdlib.h>
13 #include <dos.h>
14 #include <conio.h>
15 #include <string.h>
16 #include <io.h>
17 #include <ctype.h>
18 #include "dzcomm.h"
19 #include "allegro.h"
20
21 typedef unsigned int uint;
22 typedef unsigned short int usint;
23 typedef unsigned char byte;
24
25 #define com_(N) comm_port *com##N
26
27 com_(1);
28 com_(2);
29 com_(3);
30 com_(4);
31 com_(5);
32 com_(6);
33 com_(7);
34 com_(8);
35
36 #define com_wrapper_(N) static int com##N##_wrapper(void) \
37                        { DISABLE(); /* adb -- why this? */ \
38                           dz_comm_port_interrupt_handler(com##N##); \
39                           return(0); \
40                         } \
41                         END_OF_FUNCTION(com##N##_wrapper);
42
43 com_wrapper_(1);
44 com_wrapper_(2);
45 com_wrapper_(3);
46 com_wrapper_(4);
47 com_wrapper_(5);
48 com_wrapper_(6);
49 com_wrapper_(7);
50 com_wrapper_(8);
51
52 static comm_port *irq_bot_com_port[16]={0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0};
53 static int (*com_wrapper[8])();
54 static comm_port **com_port[8];
55
56 char szDZCommErr[50];
57 inline void dz_make_comm_err(char *szErr) {strcpy(szDZCommErr,szErr);}
58 //comm port functions
59 static inline void comm_port_rdr(comm_port *port);
60 static inline void comm_port_trx(comm_port *port);
61 static inline void interrupt_on(comm_port *port,byte _interrupt_);
62 static inline void interrupt_off(comm_port *port,byte _interrupt_);
63 extern void lock_queue_functions(void);
64 void comm_port_fifo_init(comm_port *port);
65 inline void comm_port_rtmout(comm_port *port);
66 void comm_port_uninstall(comm_port *port);
67
68 //const byte THREOFF=0xfd;
69 const byte THREINT=0x02;
70 const byte RDAINT=0x04;
71
72 //-------------------------- PRINT BIN --------------------------
73
74 void print_bin_s(int c,char *s)
75 { int i,j;
76   int mask=0x01;
77   sprintf (s,"%c : ",c);
78   for (i=0;i<4;i++)
79    { for(j=0;j<8;j++)
80       if (c&(mask<<(j+i*8))) strcat(s,"1");
81       else strcat(s,"0");
82       strcat(s,".");
83    }
84 }
85
86 //------------------------- INTERRUPT ON -----------------------------
87
88 static inline void interrupt_on(comm_port *port,byte _interrupt_)
89 { byte i;
90   i=inportb(port->IER);
91   if (!(i&_interrupt_)) outportb(port->IER,i|_interrupt_);
92 }
93 END_OF_FUNCTION(interrupt_on);
94
95 //------------------------- INTERRUPT OFF -----------------------------
96
97 static inline void interrupt_off(comm_port *port,byte _interrupt_)
98 { byte i;
99   i=inportb(port->IER);
100   if (i&_interrupt_) outportb(port->IER,i&~_interrupt_);
101 }
102 END_OF_FUNCTION(interrupt_off);
103
104 //------------------------- COMM PORT INIT --------------------------
105
106 comm_port *comm_port_init(comm com)
107 { comm_port *port=(comm_port*)malloc(sizeof(comm_port));
108
109   szDZCommErr[0]=0;
110
111   if (port==NULL)
112    { dz_make_comm_err("Out of memory !");
113      return(NULL);
114    }
115
116   if ((port->InBuf=queue_new_(4096,1))==NULL)
117    { dz_make_comm_err("Out of memory !");
118      return(NULL);
119    }
120   if ((port->OutBuf=queue_new_(4096,1))==NULL)
121    { dz_make_comm_err("Out of memory !");
122      queue_delete(port->InBuf);
123      return(NULL);
124    }
125
126   port->nPort=0;
127   //getting comport base address
128   //0x400+com*2 - memory address where stored default comm base address
129   dosmemget(0x400+com*2,2,&port->nPort);
130   if (port->nPort==0) //probably you have notebook or some brand named PC
131    { if (com==_com1||com==_com3||com==_com5||com==_com7) port->nPort=0x3f8; //default I/O address for com1 or com3
132      else port->nPort=0x2f8; //com2 or com4
133    }
134
135 //set default values (user may change it later)
136
137   if (com==_com1||com==_com3||com==_com5||com==_com7) port->nIRQ=4;
138   else port->nIRQ=3; //com2 or com4
139
140   strcpy(port->szName,"COM ");
141   port->szName[3]=com+49;
142   port->installed=NO;
143   port->nComm=com;
144   port->nBaud=_2400;
145   port->nData=BITS_8;
146   port->nStop=STOP_1;
147   port->nParity=NO_PARITY;
148   port->comm_handler=com_wrapper[com];
149   port->control_type=XON_XOFF;
150   port->msr_handler=NULL; //#d#pointer to modem status register handler.
151   port->lsr_handler=NULL; //#d#pointer to line status register handler.
152
153   _go32_dpmi_lock_data(port,sizeof(comm_port));
154   *(com_port[com])=port;
155
156   return(port);
157 }
158
159 //-------------------- COMM_PORT_FIFO_INIT ----------------------
160
161 void comm_port_fifo_init(comm_port *port)
162 {
163 //setting up FIFO if possible
164   int c=inportb(port->SCR);
165   outportb(port->SCR,0x55);
166   port->fifo = 0;
167   if(inportb(port->SCR)==0x55)  // greater then 8250
168    { outportb(port->SCR,c);
169      outportb(port->FCR,0x87);//try to enable FIFO with 8 byte trigger level
170      if ((c=inportb(port->IIR)&0xc0)!=0xc0) //If not 16550A
171        outportb(port->FCR,c&0xfe); //Disable FIFO
172        else port->fifo = 1;
173 //     else printf("\nFIFO OK\n");
174    }
175
176 }
177
178 //----------------------- COMM PORT INSTALL HANDLER ------------------
179 //modifyed by Neil Townsend to support IRQ sharing
180 int comm_port_install_handler(comm_port *port)
181 {
182   if (port==NULL)
183    { dz_make_comm_err("Set up comm parametrs first ! Call comm_port_new() first.");
184      return(0);
185    }
186   if (port->installed==YES)
187    { dz_make_comm_err("Comm already installed !");
188      return(0);
189    }
190   if (port->nIRQ>15)
191    { dz_make_comm_err("IRQ number out of range ! Must be 0 ... 15 .");
192      return(0);
193    }
194   if (port->comm_handler==NULL)
195    { dz_make_comm_err("Specify comm's handler (see 'comm_handler' member's description) !");
196      return(0);
197    }
198   if (port->nBaud==0)
199    { dz_make_comm_err("Invalid baud rate !");
200      return(0);
201    }
202
203   switch(port->control_type)
204    { case XON_XOFF :
205        port->xon=0;
206        port->xoff=0;
207        port->xonxoff_rcvd=XON_RCVD;
208        port->xonxoff_send=XON_SENT;
209        break;
210      case RTS_CTS :
211        port->cts=CTS_ON;
212        port->rts=RTS_ON; //fixed by SET (was RTS_OFF)
213        break;
214      default :
215        break;
216    }
217
218   port->THR=port->nPort;
219   port->RDR=port->nPort;
220   port->BRDL=port->nPort;
221   port->BRDH=1+port->nPort;
222   port->IER=1+port->nPort;
223   port->IIR=2+port->nPort;
224   port->FCR=2+port->nPort;
225   port->LCR=3+port->nPort;
226   port->MCR=4+port->nPort;
227   port->LSR=5+port->nPort;
228   port->MSR=6+port->nPort;
229   port->SCR=7+port->nPort;
230   { byte i;
231     for(i=0;i<8;i++) outportb(port->RDR+i,0);
232   }
233
234   comm_port_fifo_init(port);
235
236   { unsigned char temp;
237     do
238      { temp=inportb(port->RDR);
239        temp=inportb(port->LSR);
240        temp=inportb(port->MSR);
241        temp=inportb(port->IIR);
242      }
243     while(!(temp & 1));
244   }
245
246
247 //set communication parametrs
248 //MOVED forwards so done before interupts enabled
249   { int divisor=115200/port->nBaud;
250     byte divlow,divhigh;
251     byte comm_param=port->nData|(port->nStop<<2)|(port->nParity<<3);
252     // Set Port Toggle to BRDL/BRDH registers
253     outportb(port->LCR,comm_param|0x80);
254     divlow=divisor&0x000000ff;
255     divhigh=(divisor>>8)&0x000000ff;
256     outportb(port->BRDL,divlow); // Set Baud Rate
257     outportb(port->BRDH,divhigh);
258     outportb(port->LCR,comm_param&0x7F); // Set LCR and Port Toggle
259   }
260   
261 //set interrupt parametrs
262   { const byte IMR_8259_0=0x21;
263     const byte IMR_8259_1=0xa1;
264     const byte ISR_8259_0=0x20;
265     const byte ISR_8259_1=0xa0;
266     const byte IERALL = 0x0f; //mask for all communications interrupts
267     const byte MCRALL = 0x0f; //DTR,RTS,OUT1=OUT2=1 is ON
268     //calculating mask for 8259 controller's IMR
269     //and number of interrupt hadler for given irq level
270     if (port->nIRQ<=7) //if 0<=irq<=7 first IMR address used
271      { port->interrupt_enable_mask=~(0x01<<port->nIRQ);
272        port->nIRQVector=port->nIRQ+8;
273        port->IMR_8259=IMR_8259_0;
274        port->ISR_8259=ISR_8259_0;
275      }
276     else
277      { port->interrupt_enable_mask=~(0x01<<(port->nIRQ%8));
278        port->nIRQVector=0x70+(port->nIRQ-8);
279        port->IMR_8259=IMR_8259_1;
280        port->ISR_8259=ISR_8259_1;
281      }
282
283     port->next_port = NULL;
284     port->last_port = irq_bot_com_port[port->nIRQ];
285     if (irq_bot_com_port[port->nIRQ] != NULL) irq_bot_com_port[port->nIRQ]->next_port = port;
286     irq_bot_com_port[port->nIRQ] = port;
287     DISABLE();
288     if (port->last_port == NULL)
289      { // DZ orig lines in here
290        _install_irq(port->nIRQVector,port->comm_handler);
291        //enable interrupt port->nIRQ level
292        outportb(port->IMR_8259,inportb(port->IMR_8259)&
293                 port->interrupt_enable_mask);
294      }
295        
296     // DZ again:
297     outportb(port->MCR,MCRALL); //setup modem
298     outportb(port->IER,IERALL); //enable all communication's interrupts
299     // to here
300     ENABLE();
301   }
302
303   port->installed=YES;
304   return(1);
305 }
306
307 //------------------ DZ COMM PORT INTERRUPT HANDLER ---------------
308 // always return zero
309 inline int dz_comm_port_interrupt_handler(comm_port *port)
310 { int int_id;
311   int c;
312 //  putch('1');
313
314   while (1) //loop while !end of all interrupts
315    { int_id=inportb(port->IIR); //get interrupt id
316         //next loop added by Neil Townsend
317      while ((int_id&0x01)==1) //no interrupts (left) to handle on this port
318       { if (port->next_port==NULL)
319          { outportb(0x20,0x20);
320            if (port->nIRQ>7) //Thanks for SET for this fix
321              outportb(0xA0,0x20); //now IRQ8-IRQ15 handled properly.
322
323            return(0);
324          }
325         port=(comm_port*)port->next_port;
326         int_id=inportb(port->IIR);
327       }
328
329       switch (int_id)
330         {
331           case 0xcc: //Character Timeout Indication N.Lohmann 6.3.98
332                      // only possible if FiFo's are enabled.
333             comm_port_rtmout(port);
334             break;
335           case 0xc6: //FiFo LSINT
336           case 0x06: //LSINT:
337             c=inportb(port->LSR);
338             if (port->lsr_handler!=NULL) port->lsr_handler(c);
339             break;
340           case 0xc4: //FiFo RDAINT
341           case 0x04: //RDAINT
342             comm_port_rdr(port);
343             break;
344           case 0xc2: //FiFo THREINT
345           case 0x02: //THREINT :
346             comm_port_trx(port);
347             break;
348           case 0xc0: //FiFo MSINT
349           case 0x00: //MSINT :
350             c=inportb(port->MSR);
351             if (port->msr_handler!=NULL) port->msr_handler(c);
352
353             if (port->control_type==RTS_CTS)
354              { if (port->cts==CTS_OFF && c&0x10)
355                 { port->cts=CTS_ON;
356                   if (port->rts==RTS_ON)
357                     interrupt_on(port,THREINT);
358                 }
359                else
360                  if (port->cts==CTS_ON && !c&0x10)
361                   { port->cts=CTS_OFF;
362                     interrupt_off(port,THREINT);
363                   }
364               }
365             break;
366          }//end case
367    } //end while 1
368
369   return(0);
370 }
371 END_OF_FUNCTION(dz_comm_port_interrupt_handler);
372
373 //----------------------- COMM PORT RTMOUT  ------------------------
374 //Nils Lohmann 8.3.98
375 //Time Out Indication, service routine  triggered after 4 Char-times
376 //if there is at least one Byte in FiFo and no read-Cykle happened.
377
378 inline void comm_port_rtmout(comm_port *port)
379 {
380   comm_port_rdr(port);
381 }
382 END_OF_FUNCTION(comm_port_rtmout);
383
384 //----------------------- COMM PORT DELETE ------------------------
385
386 void comm_port_delete(comm_port *port)
387 {
388   if (port->installed==NO) return;
389  
390   comm_port_uninstall(port);
391
392   free(port);
393 }
394
395 //------------------------- COMM PORT OUT -----------------------------
396
397 inline void comm_port_out(comm_port *port,byte c)
398 {
399
400   queue_put_(port->OutBuf,&c);
401   switch (port->control_type)
402    { case NO_CONTROL :
403       interrupt_on(port,THREINT);
404       break;
405      case XON_XOFF : // XON/XOFF
406       if (port->xonxoff_rcvd!=XOFF_RCVD)
407         { interrupt_on(port,THREINT);
408         }
409      case RTS_CTS : // RTS_CTR
410       if (port->cts==CTS_ON) //modem is 'clear to send'
411        { if (port->rts==RTS_ON) //Fixed by SET (was RTS_OFF)
412           { interrupt_on(port,THREINT);
413           }
414       }
415       break;
416      default:
417       break;
418    }
419 }
420
421 //------------------------- COMM PORT TEST -----------------------------
422
423 inline int comm_port_test(comm_port *port)
424 { byte c;
425
426   switch (port->control_type)
427    { case NO_CONTROL :
428       break;
429      case XON_XOFF : // XON/XOFF
430       if (((port->InBuf)->tail<(port->InBuf)->fill_level)&&(port->xonxoff_send!=XON_SENT))
431         { port->xon=1;
432           interrupt_on(port,THREINT);
433         }
434       break;
435      case RTS_CTS :
436       if (((port->InBuf)->tail<(port->InBuf)->fill_level)&&(port->rts==RTS_OFF))
437         { outportb(port->MCR,inportb(port->MCR)|0x02); //setting RTS
438           port->rts=RTS_ON;
439           interrupt_on(port,THREINT);
440        }
441       break;
442      default:
443       break;
444    }
445   if (queue_empty(port->InBuf))
446    { return(-1);
447    }
448   queue_get_(port->InBuf, &c);
449   return(c);
450 }
451
452 //----------------------- COMM PORT STRING SEND -------------------------
453
454 void comm_port_string_send(comm_port *port,char *s)
455 {
456   int i;
457
458   if (s==NULL) return;
459   for (i=0;s[i]!=0;i++) comm_port_out(port,s[i]);
460 }
461
462 //---------------------- COMM PORT COMMAND SEND -------------------------
463
464 void comm_port_command_send(comm_port *port,char *s)
465 {
466   int i;
467
468   if (s==NULL) return;
469   for (i=0;s[i]!=0;i++)comm_port_out(port,s[i]);
470   comm_port_out(port,'\r');
471 }
472
473 //------------------- MODEM HANG UP -----------------
474
475 void modem_hangup(comm_port *port)
476 {
477   comm_port_out(port,2);
478   delay(3000);
479   comm_port_string_send(port,"+++");
480   delay(3000);
481   comm_port_string_send(port,"ATH0\r");
482 }
483
484 //---------------------- COMM PORT HAND ---------------------------
485
486 void comm_port_hand(comm_port *port,int m)
487 { int c;
488   c=inportb(port->MCR);
489   outportb(port->MCR,c&m);
490 }
491
492 inline int comm_port_send_xoff(comm_port *port)
493 {
494   if (port->xonxoff_send!=XOFF_SENT)
495    { port->xoff=1;
496      interrupt_on(port,THREINT);
497    }
498   return(1);
499 }
500
501 inline int comm_port_send_xon(comm_port *port)
502 {
503   if (port->xonxoff_send!=XON_SENT)
504    { port->xon=1;
505      interrupt_on(port,THREINT);
506    }
507   return(1);
508 }
509
510 //-------------------- COMM PORT LOAD SETTINGS ---------------------
511
512 #ifdef __DEVICE__
513 int comm_port_load_settings(device *dev,char *ini_name)
514 #else
515 int comm_port_load_settings(comm_port *port,char *ini_name)
516 #endif
517 {
518   #ifdef __DEVICE__
519   comm_port *port=dev->device_user_data;
520   #endif
521   FILE *ini;
522   int l,i;
523   char *buf,*buf_end,*s,v[64];
524   comm com=port->nComm;
525   char com_name[7]={'[','c','o','m',com+49,']',0};
526   char com_end[11]={'[','c','o','m',com+49,' ','e','n','d',']',0};
527
528   if ((ini=fopen(ini_name,"rt"))==NULL) return(0);
529   l=filelength(fileno(ini));
530   if ((buf=(char*)alloca(l))==NULL)
531     { fclose(ini);
532       return(0);
533     }
534
535   l=fread(buf,1,l,ini);
536   fclose(ini);
537   buf[l]=0;
538   strlwr(buf);
539
540   s=strstr(buf,com_name);
541   buf_end=strstr(buf,com_end);
542
543   if (s==NULL||buf_end==NULL) return(-1);
544   *buf_end=0;
545
546   //get baud rate
547   if ((s=strstr(buf,"baud"))!=NULL)
548    { if (not_commented(s)&&(s=strchr(s,'='))!=NULL)
549       { s++;i=0;
550         while ((*s!=';')&&(*s!='\n')&&(*s!=0)&&(i<9))
551          if (!isspace(*s)) v[i++]=*s++;
552
553         v[i]=0;
554         if ((i=atoi(v))!=0) port->nBaud=i;
555       }
556    }
557
558   //get irq number
559   if ((s=strstr(buf,"irq"))!=NULL)
560    { if (not_commented(s)&&(s=strchr(s,'='))!=NULL)
561       { s++;i=0;
562         while ((*s!=';')&&(*s!='\n')&&(*s!=0)&&(i<9))
563          if (!isspace(*s)) v[i++]=*s++;
564
565         v[i]=0;
566         if ((i=atoi(v))!=0) port->nIRQ=i;
567       }
568    }
569
570   //get comm address
571   if ((s=strstr(buf,"address"))!=NULL)
572    { if (not_commented(s)&&(s=strchr(s,'='))!=NULL)
573       { s++;i=0;
574         while ((*s!=';')&&(*s!='\n')&&(*s!=0)&&(i<9))
575          if (!isspace(*s)) v[i++]=*s++;
576
577         v[i]=0;
578         if ((i=strtol(v,NULL,0))!=0) port->nPort=strtol(v,NULL,0);
579       }
580    }
581
582   //get data bits
583   if ((s=strstr(buf,"data"))!=NULL)
584    { if (not_commented(s)&&(s=strchr(s,'='))!=NULL)
585        { s++;i=0;
586          while ((*s!=';')&&(*s!='\n')&&(*s!=0)&&(i<9))
587           if (!isspace(*s)) v[i++]=*s++;
588
589          v[i]=0;
590          if ((i=atoi(v))!=0)
591           switch (i)
592            { case 8 :
593               port->nData=BITS_8;
594               break;
595              case 7 :
596               port->nData=BITS_7;
597               break;
598              case 6 :
599               port->nData=BITS_6;
600               break;
601              case 5 :
602               port->nData=BITS_5;
603               break;
604            }
605        }
606    }
607
608   //get parity bits
609   if ((s=strstr(buf,"parity"))!=NULL)
610    { if (not_commented(s)&&(s=strchr(s,'='))!=NULL)
611        { s++;i=0;
612          while ((*s!=';')&&(*s!='\n')&&(*s!=0)&&(i<9))
613           if (!isspace(*s)) v[i++]=*s++;
614          v[i]=0;
615
616          if (strcmp(v,"even")==0) port->nParity=EVEN_PARITY;
617          else
618         if (strcmp(v,"odd")==0) port->nParity=ODD_PARITY;
619          else
620          if (strcmp(v,"no")==0||strcmp(v,"none")==0) port->nParity=NO_PARITY;
621        }
622    }
623
624   //get control type
625   if ((s=strstr(buf,"control"))!=NULL)
626    { if (not_commented(s)&&(s=strchr(s,'='))!=NULL)
627        { s++;i=0;
628          while ((*s!=';')&&(*s!='\n')&&(*s!=0)&&(i<9))
629           if (!isspace(*s)) v[i++]=*s++;
630          v[i]=0;
631
632          if (strcmp(v,"xon_xoff")==0||strcmp(v,"xon/xoff")==0) port->control_type=XON_XOFF;
633          else
634           if (strcmp(v,"no")==0||strcmp(v,"none")==0) port->control_type=NO_CONTROL;
635           else
636           if (strcmp(v,"rts_cts")==0||strcmp(v,"rts/cts")==0) port->control_type=RTS_CTS;
637       }
638    }
639
640   if ((s=strstr(buf,"stop"))!=NULL) //get stop bits
641    { if (not_commented(s)&&(s=strchr(s,'='))!=NULL)
642        { s++;i=0;
643          while ((*s!=';')&&(*s!='\n')&&(*s!=0)&&(i<9))
644           if (!isspace(*s)) v[i++]=*s++;
645
646          v[i]=0;
647          if ((i=atoi(v))!=0)
648           switch (i)
649            { case 1 :
650               port->nStop=STOP_1;
651               break;
652              case 2 :
653               port->nStop=STOP_2;
654               break;
655            }
656        }
657    }
658
659   if ((s=strstr(buf,"name"))!=NULL)
660    { if (not_commented(s)&&(s=strchr(s,'='))!=NULL)
661       { s++;i=0;
662         while ((*s!=';')&&(*s!='\n')&&(*s!=0)&&(i<64))
663          v[i++]=*s++;
664
665         v[i]=0;
666         strcpy(port->szName,v);
667       }
668    }
669
670   return(1);
671 }
672
673
674 //----------------------- COMM PORT RDR ------------------------
675
676 static inline void comm_port_rdr(comm_port *port)
677 { byte c;
678   int n;
679
680   do {
681     c = inportb(port->RDR);
682     switch (port->control_type)
683      { case NO_CONTROL :
684        queue_put_(port->InBuf,&c);
685        port->in_cnt++;
686        break;
687        case XON_XOFF : // XON/XOFF
688        if (c==XON_ASCII)
689         { port->xonxoff_rcvd=XON_RCVD;
690           interrupt_on(port,THREINT);
691           return;
692         }
693        if (c==XOFF_ASCII)
694         { port->xonxoff_rcvd=XOFF_RCVD;
695           interrupt_off(port,THREINT);
696           return;
697         }
698        n=queue_put_(port->InBuf,&c);
699        port->in_cnt++;
700        if (n) //buffer is near full
701         { if (port->xonxoff_send!=XOFF_SENT)
702            { port->xoff=1;
703              interrupt_on(port,THREINT);
704            }
705         }
706        break;
707        case RTS_CTS:
708       n=queue_put_(port->InBuf,&c);
709        port->in_cnt++;
710        if (n) //buffer is near full
711         { outportb(port->MCR,inportb(port->MCR)&(~0x02)); //dropping RTS
712           port->rts=RTS_OFF;
713         }
714        break;
715        default :
716        break;
717      }
718      c =inportb(port->LSR);
719   } while (c & 1);
720   // these lines are a cure for the well-known problem of TX interrupt
721   // lock-ups when receiving and transmitting at the same time
722   if (c & 0x40)
723     comm_port_trx(port);
724 }
725 static END_OF_FUNCTION(comm_port_rdr)
726
727 //----------------------- COMM PORT TRX ------------------------
728
729 static inline void comm_port_trx(comm_port *port)
730 { byte c;
731   int i, count = port->fifo ? 16 : 1;
732
733   for (i = count; i--; ) {
734     switch (port->control_type)
735      { case NO_CONTROL :
736        if (queue_empty(port->OutBuf))//queue empty, nothig to send
737         { interrupt_off(port,THREINT);
738           return;
739         }
740        queue_get_(port->OutBuf, &c);
741        port->out_cnt++;
742        outportb(port->THR,c);
743        break;
744        case XON_XOFF : // XON/XOFF
745        if (port->xoff==1)
746         { outportb(port->THR,XOFF_ASCII);
747           port->xoff=0;
748           port->xonxoff_send=XOFF_SENT;
749         }
750        else if (port->xon==1)
751         { outportb(port->THR,XON_ASCII);
752           port->xon=0;
753           port->xonxoff_send=XON_SENT;
754           return;
755         }
756        if (queue_empty(port->OutBuf))//queue empty, nothig to send
757         { interrupt_off(port,THREINT);
758           return;
759         }
760        queue_get_(port->OutBuf, &c);
761        outportb(port->THR,c);
762        port->out_cnt++;
763        break;
764        case RTS_CTS:
765        if (port->cts==CTS_OFF)
766         { return;
767         }
768        if (port->rts==RTS_OFF)
769         { port->rts=RTS_ON;
770           outportb(port->MCR,inportb(port->MCR)|0x02); //setting RTS
771         }
772        if (queue_empty(port->OutBuf))//queue empty, nothig to send
773         { outportb(port->MCR,inportb(port->MCR)&(~0x02)); //dropping RTS
774           port->rts=RTS_OFF;
775           interrupt_off(port,THREINT);
776           return;
777         }
778        queue_get_(port->OutBuf, &c);
779        outportb(port->THR,c);
780        port->out_cnt++;
781        break;
782        default :
783        break;
784      }
785   }
786 }
787 static END_OF_FUNCTION(comm_port_trx);
788
789 //------------------------- COMM PORT INIT -----------------------------
790
791 void dzcomm_init(void)
792 {
793   LOCK_FUNCTION(dz_comm_port_interrupt_handler);
794   LOCK_FUNCTION(comm_port_rdr);
795   LOCK_FUNCTION(comm_port_trx);
796   LOCK_FUNCTION(interrupt_on);
797   LOCK_FUNCTION(interrupt_off);
798   LOCK_FUNCTION(com1_wrapper);
799   LOCK_FUNCTION(com2_wrapper);
800   LOCK_FUNCTION(com3_wrapper);
801   LOCK_FUNCTION(com4_wrapper);
802   LOCK_FUNCTION(com5_wrapper);
803   LOCK_FUNCTION(com6_wrapper);
804   LOCK_FUNCTION(com7_wrapper);
805   LOCK_FUNCTION(com8_wrapper);
806   LOCK_VARIABLE(com1);
807   LOCK_VARIABLE(com2);
808   LOCK_VARIABLE(com3);
809   LOCK_VARIABLE(com4);
810   LOCK_VARIABLE(com5);
811   LOCK_VARIABLE(com6);
812   LOCK_VARIABLE(com7);
813   LOCK_VARIABLE(com8);
814   com1=NULL;
815   com2=NULL;
816   com3=NULL;
817   com4=NULL;
818   com5=NULL;
819   com6=NULL;
820   com7=NULL;
821   com8=NULL;
822   com_wrapper[0]=com1_wrapper;
823   com_wrapper[1]=com2_wrapper;
824   com_wrapper[2]=com3_wrapper;
825   com_wrapper[3]=com4_wrapper;
826   com_wrapper[4]=com5_wrapper;
827   com_wrapper[5]=com6_wrapper;
828   com_wrapper[6]=com7_wrapper;
829   com_wrapper[7]=com8_wrapper;
830   com_port[0]=&com1;
831   com_port[1]=&com2;
832   com_port[2]=&com3;
833   com_port[3]=&com4;
834   com_port[4]=&com5;
835   com_port[5]=&com6;
836   com_port[6]=&com7;
837   com_port[7]=&com8;
838
839 }
840
841 //----------------------- COMM PORT UNINSTALL ---------------------
842 // New routine to allow uninstalling without deleting
843 // and to simplyfy _delete and _reinstall
844 // by Neil Townsend
845 void comm_port_uninstall(comm_port *port)
846 { comm_port *i_port;
847
848   if (port->installed==NO) return;
849   i_port = irq_bot_com_port[port->nIRQ];
850
851   DISABLE();
852   if (i_port == port)
853    { irq_bot_com_port[port->nIRQ] = (comm_port *) port->last_port;
854      if (irq_bot_com_port[port->nIRQ]) irq_bot_com_port[port->nIRQ]->next_port = NULL;
855      i_port = NULL;
856    }
857   else i_port = (comm_port *) i_port->last_port;
858   while (i_port)
859    { if (i_port == port)
860       { if (i_port->last_port) ((comm_port *)i_port->last_port)->next_port = i_port->next_port;
861         if (i_port->next_port) ((comm_port *)i_port->next_port)->last_port = i_port->last_port;
862         i_port = NULL;
863       }
864      if (i_port) i_port = i_port->last_port;
865    }
866
867   if (irq_bot_com_port[port->nIRQ] == NULL) _remove_irq(port->nIRQVector);
868
869   { const byte IEROFF=0x00;
870     const byte MCROFF=0x00;
871     outportb(port->IER,IEROFF);
872     outportb(port->MCR,MCROFF);
873     outportb(port->IMR_8259,inportb(port->IMR_8259)&~(port->interrupt_enable_mask));
874   }
875   ENABLE();
876   port->installed = NO;
877
878 }
879
880
881 //----------------------- COMM PORT REINSTALL ---------------------------
882
883 int comm_port_reinstall(comm_port *port)
884 {
885   if (port->installed==NO) return(0);
886
887   comm_port_uninstall(port);
888   return (comm_port_install_handler(port));
889 }