[363] | 1 | /*
|
---|
| 2 | * TOPPERS/JSP Kernel
|
---|
| 3 | * Toyohashi Open Platform for Embedded Real-Time Systems/
|
---|
| 4 | * Just Standard Profile Kernel
|
---|
| 5 | *
|
---|
| 6 | * Copyright (C) 2000,2001 by Embedded and Real-Time Systems Laboratory
|
---|
| 7 | * Toyohashi Univ. of Technology, JAPAN
|
---|
| 8 | * Copyright (C) 2002 by Monami software, Limited Partners.
|
---|
| 9 | * Copyright (C) 2002 by MURANAKA Masaki
|
---|
| 10 | * Copyright (C) 2008- by Monami Software Limited Partnership, JAPAN
|
---|
| 11 | *
|
---|
| 12 | * ä¸è¨èä½æ¨©è
|
---|
| 13 | ã¯ï¼ä»¥ä¸ã®(1)ã(4)ã®æ¡ä»¶ãæºããå ´åã«éãï¼æ¬ã½ããã¦ã§
|
---|
| 14 | * ã¢ï¼æ¬ã½ããã¦ã§ã¢ãæ¹å¤ãããã®ãå«ãï¼ä»¥ä¸åãï¼ã使ç¨ã»è¤è£½ã»æ¹
|
---|
| 15 | * å¤ã»åé
|
---|
| 16 | å¸ï¼ä»¥ä¸ï¼å©ç¨ã¨å¼ã¶ï¼ãããã¨ãç¡åã§è¨±è«¾ããï¼
|
---|
| 17 | * (1) æ¬ã½ããã¦ã§ã¢ãã½ã¼ã¹ã³ã¼ãã®å½¢ã§å©ç¨ããå ´åã«ã¯ï¼ä¸è¨ã®èä½
|
---|
| 18 | * 権表示ï¼ãã®å©ç¨æ¡ä»¶ããã³ä¸è¨ã®ç¡ä¿è¨¼è¦å®ãï¼ãã®ã¾ã¾ã®å½¢ã§ã½ã¼
|
---|
| 19 | * ã¹ã³ã¼ãä¸ã«å«ã¾ãã¦ãããã¨ï¼
|
---|
| 20 | * (2) æ¬ã½ããã¦ã§ã¢ãï¼ã©ã¤ãã©ãªå½¢å¼ãªã©ï¼ä»ã®ã½ããã¦ã§ã¢éçºã«ä½¿
|
---|
| 21 | * ç¨ã§ããå½¢ã§åé
|
---|
| 22 | å¸ããå ´åã«ã¯ï¼åé
|
---|
| 23 | å¸ã«ä¼´ãããã¥ã¡ã³ãï¼å©ç¨
|
---|
| 24 | * è
|
---|
| 25 | ããã¥ã¢ã«ãªã©ï¼ã«ï¼ä¸è¨ã®èä½æ¨©è¡¨ç¤ºï¼ãã®å©ç¨æ¡ä»¶ããã³ä¸è¨
|
---|
| 26 | * ã®ç¡ä¿è¨¼è¦å®ãæ²è¼ãããã¨ï¼
|
---|
| 27 | * (3) æ¬ã½ããã¦ã§ã¢ãï¼æ©å¨ã«çµã¿è¾¼ããªã©ï¼ä»ã®ã½ããã¦ã§ã¢éçºã«ä½¿
|
---|
| 28 | * ç¨ã§ããªãå½¢ã§åé
|
---|
| 29 | å¸ããå ´åã«ã¯ï¼æ¬¡ã®ããããã®æ¡ä»¶ãæºããã
|
---|
| 30 | * ã¨ï¼
|
---|
| 31 | * (a) åé
|
---|
| 32 | å¸ã«ä¼´ãããã¥ã¡ã³ãï¼å©ç¨è
|
---|
| 33 | ããã¥ã¢ã«ãªã©ï¼ã«ï¼ä¸è¨ã®è
|
---|
| 34 | * ä½æ¨©è¡¨ç¤ºï¼ãã®å©ç¨æ¡ä»¶ããã³ä¸è¨ã®ç¡ä¿è¨¼è¦å®ãæ²è¼ãããã¨ï¼
|
---|
| 35 | * (b) åé
|
---|
| 36 | å¸ã®å½¢æ
|
---|
| 37 | ãï¼å¥ã«å®ããæ¹æ³ã«ãã£ã¦ï¼TOPPERSããã¸ã§ã¯ãã«
|
---|
| 38 | * å ±åãããã¨ï¼
|
---|
| 39 | * (4) æ¬ã½ããã¦ã§ã¢ã®å©ç¨ã«ããç´æ¥çã¾ãã¯éæ¥çã«çãããããªãæ
|
---|
| 40 | * 害ãããï¼ä¸è¨èä½æ¨©è
|
---|
| 41 | ããã³TOPPERSããã¸ã§ã¯ããå
|
---|
| 42 | 責ãããã¨ï¼
|
---|
| 43 | * ã¾ãï¼æ¬ã½ããã¦ã§ã¢ã®ã¦ã¼ã¶ã¾ãã¯ã¨ã³ãã¦ã¼ã¶ããã®ãããªãç
|
---|
| 44 | * ç±ã«åºã¥ãè«æ±ãããï¼ä¸è¨èä½æ¨©è
|
---|
| 45 | ããã³TOPPERSããã¸ã§ã¯ãã
|
---|
| 46 | * å
|
---|
| 47 | 責ãããã¨ï¼
|
---|
| 48 | *
|
---|
| 49 | * æ¬ã½ããã¦ã§ã¢ã¯ï¼ç¡ä¿è¨¼ã§æä¾ããã¦ãããã®ã§ããï¼ä¸è¨èä½æ¨©è
|
---|
| 50 | ã
|
---|
| 51 | * ãã³TOPPERSããã¸ã§ã¯ãã¯ï¼æ¬ã½ããã¦ã§ã¢ã«é¢ãã¦ï¼ç¹å®ã®ä½¿ç¨ç®ç
|
---|
| 52 | * ã«å¯¾ããé©åæ§ãå«ãã¦ï¼ãããªãä¿è¨¼ãè¡ããªãï¼ã¾ãï¼æ¬ã½ããã¦ã§
|
---|
| 53 | * ã¢ã®å©ç¨ã«ããç´æ¥çã¾ãã¯éæ¥çã«çãããããªãæ害ã«é¢ãã¦ãï¼ã
|
---|
| 54 | * ã®è²¬ä»»ãè² ããªãï¼
|
---|
| 55 | *
|
---|
| 56 | * @(#) $Id$
|
---|
| 57 | */
|
---|
| 58 |
|
---|
| 59 | /*
|
---|
| 60 | * COMãã©ã¤ãï¼PC/ATç¨ï¼
|
---|
| 61 | */
|
---|
| 62 |
|
---|
| 63 | #include <s_services.h>
|
---|
| 64 | #include <pcat_com.h>
|
---|
| 65 |
|
---|
| 66 | #define PCAT_COM_IIR_RLS (0x06)
|
---|
| 67 | #define PCAT_COM_IIR_RXD (0x04)
|
---|
| 68 | #define PCAT_COM_IIR_TXD (0x02)
|
---|
| 69 |
|
---|
| 70 | #define PCAT_COM_IER_LS (4)
|
---|
| 71 | #define PCAT_COM_IER_TX (2)
|
---|
| 72 | #define PCAT_COM_IER_RX (1)
|
---|
| 73 |
|
---|
| 74 | #define PCAT_COM_RBR 0
|
---|
| 75 | #define PCAT_COM_THR 0
|
---|
| 76 | #define PCAT_COM_DLL 0
|
---|
| 77 | #define PCAT_COM_IER 1
|
---|
| 78 | #define PCAT_COM_DLM 1
|
---|
| 79 | #define PCAT_COM_IIR 2
|
---|
| 80 | #define PCAT_COM_FCR 2
|
---|
| 81 | #define PCAT_COM_LCR 3
|
---|
| 82 | #define PCAT_COM_MCR 4
|
---|
| 83 | #define PCAT_COM_LSR 5
|
---|
| 84 | #define PCAT_COM_MSR 6
|
---|
| 85 | #define PCAT_COM_SCR 7
|
---|
| 86 |
|
---|
| 87 | #define PCAT_COM_DIVISOR_LATCH(a) (24000000 / 13 / 16 / (a))
|
---|
| 88 |
|
---|
| 89 | #ifndef PCAT_COM1_BAUD_RATE
|
---|
| 90 | #define PCAT_COM1_BAUD_RATE 9600
|
---|
| 91 | #endif
|
---|
| 92 | #if TNUM_SIOP >= 2
|
---|
| 93 | #ifndef PCAT_COM2_BAUD_RATE
|
---|
| 94 | #define PCAT_COM2_BAUD_RATE 9600
|
---|
| 95 | #endif
|
---|
| 96 | #endif
|
---|
| 97 |
|
---|
| 98 | /*
|
---|
| 99 | * ä½ã¬ãã«ãã¼ãæ
|
---|
| 100 | å ±ç®¡çãããã¯ã®åæå¤
|
---|
| 101 | */
|
---|
| 102 | const SIOPINIB siopinib_table[TNUM_SIOP] = {
|
---|
| 103 | {
|
---|
| 104 | PCAT_COM1_BASE,
|
---|
| 105 | TO_INTNO(PCAT_COM1_INHNO),
|
---|
| 106 | PCAT_COM_DIVISOR_LATCH(PCAT_COM1_BAUD_RATE)
|
---|
| 107 | },
|
---|
| 108 | #if TNUM_SIOP >= 2
|
---|
| 109 | {
|
---|
| 110 | PCAT_COM2_BASE,
|
---|
| 111 | TO_INTNO(PCAT_COM2_INHNO),
|
---|
| 112 | PCAT_COM_DIVISOR_LATCH(PCAT_COM2_BAUD_RATE)
|
---|
| 113 | },
|
---|
| 114 | #endif
|
---|
| 115 | };
|
---|
| 116 | SIOPCB siopcb_table[TNUM_SIOP];
|
---|
| 117 |
|
---|
| 118 | Inline UB pcat_com_read(UH base, UH offset) {
|
---|
| 119 | return sil_reb_iop((VP)(base + offset));
|
---|
| 120 | }
|
---|
| 121 |
|
---|
| 122 | Inline void pcat_com_write(UH base, UH offset, UB data) {
|
---|
| 123 | sil_wrb_iop((VP)(base + offset), data);
|
---|
| 124 | }
|
---|
| 125 |
|
---|
| 126 | /*
|
---|
| 127 | * æåãåä¿¡ãããï¼
|
---|
| 128 | */
|
---|
| 129 | Inline BOOL
|
---|
| 130 | hw_port_getready(SIOPCB *p)
|
---|
| 131 | {
|
---|
| 132 | UB stat;
|
---|
| 133 | stat = pcat_com_read(p->siopinib->base_address, PCAT_COM_LSR);
|
---|
| 134 |
|
---|
| 135 | return ((stat & 0x01) != 0);
|
---|
| 136 | }
|
---|
| 137 |
|
---|
| 138 | /*
|
---|
| 139 | * æåãéä¿¡ã§ãããï¼
|
---|
| 140 | */
|
---|
| 141 | Inline BOOL
|
---|
| 142 | hw_port_putready(SIOPCB *p)
|
---|
| 143 | {
|
---|
| 144 | UB stat;
|
---|
| 145 | stat = pcat_com_read(p->siopinib->base_address, PCAT_COM_LSR);
|
---|
| 146 |
|
---|
| 147 | return ((stat & 0x20) != 0);
|
---|
| 148 | }
|
---|
| 149 |
|
---|
| 150 | SIOPCB *
|
---|
| 151 | pcat_com_set_mode(ID portid) {
|
---|
| 152 | SIOPCB *p;
|
---|
| 153 |
|
---|
| 154 | p = &(siopcb_table[portid - 1]);
|
---|
| 155 | if (p->initflag) {
|
---|
| 156 | return p;
|
---|
| 157 | }
|
---|
| 158 | pcat_com_write(p->siopinib->base_address, PCAT_COM_IER, 0); // Disable interrupt.
|
---|
| 159 | pcat_com_write(p->siopinib->base_address, PCAT_COM_LCR, 0x83); // DLAB=1, 8bit, stop=1, Non parity.
|
---|
| 160 | pcat_com_write(p->siopinib->base_address, PCAT_COM_DLL, (UB)p->siopinib->divisor_latch);
|
---|
| 161 | pcat_com_write(p->siopinib->base_address, PCAT_COM_DLM, (UB)(p->siopinib->divisor_latch >> 8));
|
---|
| 162 | pcat_com_write(p->siopinib->base_address, PCAT_COM_LCR, 0x03); // DLAB=0, 8bit, stop=1, Non parity.
|
---|
| 163 | pcat_com_write(p->siopinib->base_address, PCAT_COM_FCR, 0x07); // Enable FIFO.
|
---|
| 164 |
|
---|
| 165 |
|
---|
| 166 | pcat_com_read(p->siopinib->base_address, PCAT_COM_LSR);
|
---|
| 167 | pcat_com_read(p->siopinib->base_address, PCAT_COM_RBR);
|
---|
| 168 | pcat_com_read(p->siopinib->base_address, PCAT_COM_IIR);
|
---|
| 169 | pcat_com_read(p->siopinib->base_address, PCAT_COM_MCR);
|
---|
| 170 |
|
---|
| 171 | p->initflag = TRUE; /* åæåãã©ã°è¨å® */
|
---|
| 172 |
|
---|
| 173 | return p;
|
---|
| 174 | }
|
---|
| 175 |
|
---|
| 176 | void pcat_com_isr(VP_INT exinf) {
|
---|
| 177 | SIOPCB *p = (SIOPCB *)exinf;
|
---|
| 178 | while (1) {
|
---|
| 179 | switch (pcat_com_read(p->siopinib->base_address, PCAT_COM_IIR) & 7) {
|
---|
| 180 | case PCAT_COM_IIR_TXD:
|
---|
| 181 | pcat_com_ierdy_snd(p->spcb);
|
---|
| 182 | break;
|
---|
| 183 | case PCAT_COM_IIR_RXD:
|
---|
| 184 | pcat_com_ierdy_rcv(p->spcb);
|
---|
| 185 | break;
|
---|
| 186 | case PCAT_COM_IIR_RLS:
|
---|
| 187 | pcat_com_read(p->siopinib->base_address, PCAT_COM_LSR);
|
---|
| 188 | break;
|
---|
| 189 | default:
|
---|
| 190 | return;
|
---|
| 191 | }
|
---|
| 192 | }
|
---|
| 193 | }
|
---|
| 194 |
|
---|
| 195 | void
|
---|
| 196 | pcat_com_initialize()
|
---|
| 197 | {
|
---|
| 198 | UINT i;
|
---|
| 199 | for (i = 0; i < TNUM_SIOP; ++i) {
|
---|
| 200 | siopcb_table[i].siopinib = &siopinib_table[i];
|
---|
| 201 | }
|
---|
| 202 | }
|
---|
| 203 |
|
---|
| 204 | /*
|
---|
| 205 | * ã·ãªã¢ã«I/Oãã¼ãã®å²è¾¼ã¿ãã³ãã©
|
---|
| 206 | */
|
---|
| 207 | void
|
---|
| 208 | pcat_com1_handler()
|
---|
| 209 | {
|
---|
| 210 | pcat_com_isr(&siopcb_table[0]);
|
---|
| 211 | }
|
---|
| 212 | #if TNUM_PORT >= 2
|
---|
| 213 | void
|
---|
| 214 | pcat_com2_handler()
|
---|
| 215 | {
|
---|
| 216 | pcat_com_isr(&siopcb_table[1]);
|
---|
| 217 | }
|
---|
| 218 | #endif
|
---|
| 219 |
|
---|
| 220 | SIOPCB *
|
---|
| 221 | pcat_com_opn_por(ID portid, VP_INT spcb)
|
---|
| 222 | {
|
---|
| 223 | SIOPCB *p;
|
---|
| 224 |
|
---|
| 225 | p = pcat_com_set_mode(portid);
|
---|
| 226 | p->spcb = spcb;
|
---|
| 227 |
|
---|
| 228 | pcat_com_write(p->siopinib->base_address, PCAT_COM_MCR, 0x0b); // Enable OUT2 interrupt.
|
---|
| 229 |
|
---|
| 230 | return p;
|
---|
| 231 | }
|
---|
| 232 |
|
---|
| 233 | /*
|
---|
| 234 | * ã·ãªã¢ã«I/Oãã¼ãã®çµäº
|
---|
| 235 | */
|
---|
| 236 | void
|
---|
| 237 | pcat_com_cls_por(SIOPCB *p)
|
---|
| 238 | {
|
---|
| 239 |
|
---|
| 240 | p->initflag = FALSE;
|
---|
| 241 | pcat_com_write(p->siopinib->base_address, PCAT_COM_IER, 0); // Disable interrupt.
|
---|
| 242 | }
|
---|
| 243 |
|
---|
| 244 | /*
|
---|
| 245 | * åä¿¡ããæåã®åãåºã
|
---|
| 246 | */
|
---|
| 247 | INT
|
---|
| 248 | pcat_com_rcv_chr(SIOPCB *p)
|
---|
| 249 | {
|
---|
| 250 | UB ch;
|
---|
| 251 |
|
---|
| 252 | if (!hw_port_getready(p)) {
|
---|
| 253 | return -1;
|
---|
| 254 | }
|
---|
| 255 | ch = pcat_com_read(p->siopinib->base_address, PCAT_COM_RBR);
|
---|
| 256 | return (INT)ch;
|
---|
| 257 | }
|
---|
| 258 |
|
---|
| 259 | /*
|
---|
| 260 | * éä¿¡ããæåã®æ¸ãè¾¼ã¿
|
---|
| 261 | */
|
---|
| 262 | BOOL
|
---|
| 263 | pcat_com_snd_chr(SIOPCB *p, char c)
|
---|
| 264 | {
|
---|
| 265 | if (!hw_port_putready(p)) {
|
---|
| 266 | return FALSE;
|
---|
| 267 | }
|
---|
| 268 | pcat_com_write(p->siopinib->base_address, PCAT_COM_THR, c);
|
---|
| 269 | return TRUE;
|
---|
| 270 | }
|
---|
| 271 |
|
---|
| 272 | void
|
---|
| 273 | pcat_com_ena_cbr(SIOPCB *siopcb, UINT cbrtn)
|
---|
| 274 | {
|
---|
| 275 | UB ier = pcat_com_read(siopcb->siopinib->base_address, PCAT_COM_IER);
|
---|
| 276 | if (cbrtn == SIO_ERDY_SND) {
|
---|
| 277 | ier |= PCAT_COM_IER_TX;
|
---|
| 278 | } else if (cbrtn == SIO_ERDY_RCV) {
|
---|
| 279 | ier |= PCAT_COM_IER_LS | PCAT_COM_IER_RX;
|
---|
| 280 | }
|
---|
| 281 | pcat_com_write(siopcb->siopinib->base_address, PCAT_COM_IER, ier);
|
---|
| 282 | }
|
---|
| 283 |
|
---|
| 284 | void
|
---|
| 285 | pcat_com_dis_cbr(SIOPCB *siopcb, UINT cbrtn)
|
---|
| 286 | {
|
---|
| 287 | UB ier = pcat_com_read(siopcb->siopinib->base_address, PCAT_COM_IER);
|
---|
| 288 | if (cbrtn == SIO_ERDY_SND) {
|
---|
| 289 | ier &= ~PCAT_COM_IER_TX;
|
---|
| 290 | } else if (cbrtn == SIO_ERDY_RCV) {
|
---|
| 291 | ier &= ~(PCAT_COM_IER_LS | PCAT_COM_IER_RX);
|
---|
| 292 | }
|
---|
| 293 | pcat_com_write(siopcb->siopinib->base_address, PCAT_COM_IER, ier);
|
---|
| 294 | }
|
---|
| 295 |
|
---|
| 296 | void pcat_com_init(ID siopid) {
|
---|
| 297 | pcat_com_initialize();
|
---|
| 298 | pcat_com_set_mode(siopid);
|
---|
| 299 | }
|
---|
| 300 |
|
---|
| 301 | void pcat_com_putc(ID siopid, char c) {
|
---|
| 302 | SIOPCB *p;
|
---|
| 303 | p = &siopcb_table[siopid - 1];
|
---|
| 304 | while (!pcat_com_snd_chr(p, c)) {
|
---|
| 305 | }
|
---|
| 306 | }
|
---|