[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-2003 by Embedded and Real-Time Systems Laboratory
|
---|
| 7 | * Toyohashi Univ. of Technology, JAPAN
|
---|
| 8 | * Copyright (C) 2003-2004 by Ryosuke Takeuchi
|
---|
| 9 | * Platform Development Center RICOH COMPANY,LTD. JAPAN
|
---|
| 10 | *
|
---|
| 11 | * ä¸è¨èä½æ¨©è
|
---|
| 12 | ã¯ï¼Free Software Foundation ã«ãã£ã¦å
|
---|
| 13 | ¬è¡¨ããã¦ãã
|
---|
| 14 | * GNU General Public License ã® Version 2 ã«è¨è¿°ããã¦ããæ¡ä»¶ãï¼ä»¥
|
---|
| 15 | * ä¸ã®(1)ã(4)ã®æ¡ä»¶ãæºããå ´åã«éãï¼æ¬ã½ããã¦ã§ã¢ï¼æ¬ã½ããã¦ã§
|
---|
| 16 | * ã¢ãæ¹å¤ãããã®ãå«ãï¼ä»¥ä¸åãï¼ã使ç¨ã»è¤è£½ã»æ¹å¤ã»åé
|
---|
| 17 | å¸ï¼ä»¥ä¸ï¼
|
---|
| 18 | * å©ç¨ã¨å¼ã¶ï¼ãããã¨ãç¡åã§è¨±è«¾ããï¼
|
---|
| 19 | * (1) æ¬ã½ããã¦ã§ã¢ãã½ã¼ã¹ã³ã¼ãã®å½¢ã§å©ç¨ããå ´åã«ã¯ï¼ä¸è¨ã®èä½
|
---|
| 20 | * 権表示ï¼ãã®å©ç¨æ¡ä»¶ããã³ä¸è¨ã®ç¡ä¿è¨¼è¦å®ãï¼ãã®ã¾ã¾ã®å½¢ã§ã½ã¼
|
---|
| 21 | * ã¹ã³ã¼ãä¸ã«å«ã¾ãã¦ãããã¨ï¼
|
---|
| 22 | * (2) æ¬ã½ããã¦ã§ã¢ãåå©ç¨å¯è½ãªãã¤ããªã³ã¼ãï¼ãªãã±ã¼ã¿ãã«ãªã
|
---|
| 23 | * ã¸ã§ã¯ããã¡ã¤ã«ãã©ã¤ãã©ãªãªã©ï¼ã®å½¢ã§å©ç¨ããå ´åã«ã¯ï¼å©ç¨
|
---|
| 24 | * ã«ä¼´ãããã¥ã¡ã³ãï¼å©ç¨è
|
---|
| 25 | ããã¥ã¢ã«ãªã©ï¼ã«ï¼ä¸è¨ã®èä½æ¨©è¡¨ç¤ºï¼
|
---|
| 26 | * ãã®å©ç¨æ¡ä»¶ããã³ä¸è¨ã®ç¡ä¿è¨¼è¦å®ãæ²è¼ãããã¨ï¼
|
---|
| 27 | * (3) æ¬ã½ããã¦ã§ã¢ãåå©ç¨ä¸å¯è½ãªãã¤ããªã³ã¼ãã®å½¢ã¾ãã¯æ©å¨ã«çµ
|
---|
| 28 | * ã¿è¾¼ãã å½¢ã§å©ç¨ããå ´åã«ã¯ï¼æ¬¡ã®ããããã®æ¡ä»¶ãæºãããã¨ï¼
|
---|
| 29 | * (a) å©ç¨ã«ä¼´ãããã¥ã¡ã³ãï¼å©ç¨è
|
---|
| 30 | ããã¥ã¢ã«ãªã©ï¼ã«ï¼ä¸è¨ã®èä½
|
---|
| 31 | * 権表示ï¼ãã®å©ç¨æ¡ä»¶ããã³ä¸è¨ã®ç¡ä¿è¨¼è¦å®ãæ²è¼ãããã¨ï¼
|
---|
| 32 | * (b) å©ç¨ã®å½¢æ
|
---|
| 33 | ãï¼å¥ã«å®ããæ¹æ³ã«ãã£ã¦ï¼ä¸è¨èä½æ¨©è
|
---|
| 34 | ã«å ±åãã
|
---|
| 35 | * ãã¨ï¼
|
---|
| 36 | * (4) æ¬ã½ããã¦ã§ã¢ã®å©ç¨ã«ããç´æ¥çã¾ãã¯éæ¥çã«çãããããªãæ
|
---|
| 37 | * 害ãããï¼ä¸è¨èä½æ¨©è
|
---|
| 38 | ãå
|
---|
| 39 | 責ãããã¨ï¼
|
---|
| 40 | *
|
---|
| 41 | * æ¬ã½ããã¦ã§ã¢ã¯ï¼ç¡ä¿è¨¼ã§æä¾ããã¦ãããã®ã§ããï¼ä¸è¨èä½æ¨©è
|
---|
| 42 | ã¯ï¼
|
---|
| 43 | * æ¬ã½ããã¦ã§ã¢ã«é¢ãã¦ï¼ãã®é©ç¨å¯è½æ§ãå«ãã¦ï¼ãããªãä¿è¨¼ãè¡ã
|
---|
| 44 | * ãªãï¼ã¾ãï¼æ¬ã½ããã¦ã§ã¢ã®å©ç¨ã«ããç´æ¥çã¾ãã¯éæ¥çã«çããã
|
---|
| 45 | * ããªãæ害ã«é¢ãã¦ãï¼ãã®è²¬ä»»ãè² ããªãï¼
|
---|
| 46 | *
|
---|
| 47 | * @(#) $Id: serial_mini.c,v 1.4 2007/01/05 02:33:59 honda Exp $
|
---|
| 48 | */
|
---|
| 49 |
|
---|
| 50 | /*
|
---|
| 51 | * ã·ãªã¢ã«ã¤ã³ã¿ãã§ã¼ã¹ãã©ã¤ã
|
---|
| 52 | */
|
---|
| 53 |
|
---|
| 54 | #include <t_services.h>
|
---|
| 55 | #include <serial.h>
|
---|
| 56 | #include <hw_serial.h>
|
---|
| 57 | #include "kernel_id.h"
|
---|
| 58 |
|
---|
| 59 | /*
|
---|
| 60 | * ã·ãªã¢ã«ãã¼ã管çãããã¯ã®å®ç¾©
|
---|
| 61 | */
|
---|
| 62 |
|
---|
| 63 | #define SERIAL_BUFSZ 9 /* ã·ãªã¢ã«ã¤ã³ã¿ãã§ã¼ã¹ç¨ãããã¡ã®ãµã¤ãº */
|
---|
| 64 |
|
---|
| 65 | typedef struct serial_queue_block {
|
---|
| 66 | BOOL openflag; /* ãªã¼ãã³æ¸ã¿ãã©ã° */
|
---|
| 67 | UH base; /* hardware port base address */
|
---|
| 68 | ID rsemid; /* receive semaphore id */
|
---|
| 69 | ID ssemid; /* send semaphore id */
|
---|
| 70 | char head; /* queue head */
|
---|
| 71 | char tail; /* queue tail */
|
---|
| 72 | char size; /* ãããã¡ãµã¤ãº */
|
---|
| 73 | char buffer[SERIAL_BUFSZ]; /* ãããã¡ã¨ãªã¢ */
|
---|
| 74 | } SQUE;
|
---|
| 75 |
|
---|
| 76 | static SQUE in_queue[TNUM_SIOP] ={
|
---|
| 77 | FALSE, TADR_SFR_UART0_BASE, SERIAL_RCV_SEM1, SERIAL_SND_SEM1, 0, 0, SERIAL_BUFSZ, "",
|
---|
| 78 | FALSE, TADR_SFR_UART1_BASE, SERIAL_RCV_SEM2, SERIAL_SND_SEM2, 0, 0, SERIAL_BUFSZ, ""
|
---|
| 79 | };
|
---|
| 80 |
|
---|
| 81 | /*
|
---|
| 82 | * ã·ãªã¢ã«ãã¼ã管çãããã¯ã®å®ç¾©ã¨åæå
|
---|
| 83 | */
|
---|
| 84 |
|
---|
| 85 | #define get_sque(portid) (&(in_queue[portid-1]))
|
---|
| 86 |
|
---|
| 87 | /*
|
---|
| 88 | * SFR UARTã®åæå
|
---|
| 89 | */
|
---|
| 90 | Inline void
|
---|
| 91 | SFR_uart_initialize(ID portid)
|
---|
| 92 | {
|
---|
| 93 | SQUE *q;
|
---|
| 94 | VB *ip = (VB*)(TADR_SFR_INT_BASE+TADR_SFR_S0RIC_OFFSET);
|
---|
| 95 |
|
---|
| 96 | q = get_sque(portid);
|
---|
| 97 | /* éåä¿¡ã¢ã¼ãã¬ã¸ã¹ã¿ã®åæå */
|
---|
| 98 | sil_wrb_mem((VP)(q->base+TADR_SFR_UMR_OFFSET), MR_DEF);
|
---|
| 99 | /* éä¿¡å¶å¾¡ã¬ã¸ã¹ã¿ã®åæå */
|
---|
| 100 | sil_wrb_mem((VP)(q->base+TADR_SFR_UC0_OFFSET), C0_DEF);
|
---|
| 101 | /* 転éé度ã¬ã¸ã¹ã¿ã®åæå */
|
---|
| 102 | sil_wrb_mem((VP)(q->base+TADR_SFR_UBRG_OFFSET), BRG1_DEF);
|
---|
| 103 | /* å²è¾¼ã¿ã¬ãã«ã®è¨å® */
|
---|
| 104 | set_ic_ilvl((VP)(ip + ((INT)portid-1)*2), RB_LEVEL);
|
---|
| 105 | sil_wrb_mem((VP)(q->base+TADR_SFR_UC1_OFFSET), C1R_DEF);
|
---|
| 106 | sil_reb_mem((VP)(q->base+TADR_SFR_URB_OFFSET)); /* ããã¼ãã¼ã¿åä¿¡ */
|
---|
| 107 | sil_reb_mem((VP)(q->base+TADR_SFR_URB_OFFSET)); /* ããã¼ãã¼ã¿åä¿¡ */
|
---|
| 108 | q->openflag = TRUE;
|
---|
| 109 | }
|
---|
| 110 |
|
---|
| 111 | /*
|
---|
| 112 | * SQUEã®åä¿¡ãããã¡ãããµã¤ãºãåãåºã
|
---|
| 113 | */
|
---|
| 114 | Inline int
|
---|
| 115 | queue_size(SQUE *q)
|
---|
| 116 | {
|
---|
| 117 | int size = q->head - q->tail;
|
---|
| 118 | if(size < 0)
|
---|
| 119 | size += q->size;
|
---|
| 120 | return size;
|
---|
| 121 | }
|
---|
| 122 |
|
---|
| 123 | /*
|
---|
| 124 | * ã·ãªã¢ã«ã¤ã³ã¿ãã§ã¼ã¹ãã©ã¤ãã®èµ·å
|
---|
| 125 | */
|
---|
| 126 | void
|
---|
| 127 | serial_initialize(VP_INT exinf)
|
---|
| 128 | {
|
---|
| 129 | SFR_uart_initialize(LOGTASK_PORTID);
|
---|
| 130 | }
|
---|
| 131 |
|
---|
| 132 | /*
|
---|
| 133 | * ã·ãªã¢ã«ãã¼ãã®ãªã¼ãã³
|
---|
| 134 | */
|
---|
| 135 | ER
|
---|
| 136 | serial_opn_por(ID portid)
|
---|
| 137 | {
|
---|
| 138 | SQUE *q;
|
---|
| 139 | VB *ip=(VB*)(TADR_SFR_INT_BASE+TADR_SFR_S0RIC_OFFSET);
|
---|
| 140 | ER ercd;
|
---|
| 141 |
|
---|
| 142 | if (!(1 <= portid && portid <= TNUM_SIOP)) {
|
---|
| 143 | return(E_ID); /* ãã¼ãçªå·ã®ãã§ã㯠*/
|
---|
| 144 | }
|
---|
| 145 | q = get_sque(portid);
|
---|
| 146 |
|
---|
| 147 | _syscall(loc_cpu());
|
---|
| 148 | if (q->openflag) { /* ãªã¼ãã³æ¸ã¿ãã®ãã§ã㯠*/
|
---|
| 149 | ercd = E_OBJ;
|
---|
| 150 | }
|
---|
| 151 | else {
|
---|
| 152 | SFR_uart_initialize(portid);
|
---|
| 153 | ercd = E_OK;
|
---|
| 154 | }
|
---|
| 155 | _syscall(unl_cpu());
|
---|
| 156 | return(ercd);
|
---|
| 157 | }
|
---|
| 158 |
|
---|
| 159 | /*
|
---|
| 160 | * ã·ãªã¢ã«ãã¼ãã®ã¯ãã¼ãº
|
---|
| 161 | */
|
---|
| 162 | ER
|
---|
| 163 | serial_cls_por(ID portid)
|
---|
| 164 | {
|
---|
| 165 | SQUE *q;
|
---|
| 166 | VB *ip=(VB*)(TADR_SFR_INT_BASE+TADR_SFR_S0RIC_OFFSET);
|
---|
| 167 | ER ercd;
|
---|
| 168 |
|
---|
| 169 | if (!(1 <= portid && portid <= TNUM_SIOP)) {
|
---|
| 170 | return(E_ID); /* ãã¼ãçªå·ã®ãã§ã㯠*/
|
---|
| 171 | }
|
---|
| 172 | q = get_sque(portid);
|
---|
| 173 |
|
---|
| 174 | _syscall(loc_cpu());
|
---|
| 175 | if (!(q->openflag)) { /* ãªã¼ãã³æ¸ã¿ãã®ãã§ã㯠*/
|
---|
| 176 | ercd = E_OBJ;
|
---|
| 177 | }
|
---|
| 178 | else {
|
---|
| 179 | set_ic_ilvl((VP)(ip + ((INT)portid-1)*2), 0);
|
---|
| 180 | sil_wrb_mem((VP)(q->base+TADR_SFR_UC1_OFFSET), C1S_DEF);
|
---|
| 181 | q->openflag = FALSE;
|
---|
| 182 | ercd = E_OK;
|
---|
| 183 | }
|
---|
| 184 | _syscall(unl_cpu());
|
---|
| 185 | return(ercd);
|
---|
| 186 | }
|
---|
| 187 |
|
---|
| 188 | /*
|
---|
| 189 | * ã·ãªã¢ã«ãã¼ãã¸ã®éä¿¡
|
---|
| 190 | */
|
---|
| 191 |
|
---|
| 192 | ER_UINT
|
---|
| 193 | serial_wri_dat(ID portid, char *buf, UINT len)
|
---|
| 194 | {
|
---|
| 195 | SQUE *q;
|
---|
| 196 | unsigned int i;
|
---|
| 197 | unsigned char c;
|
---|
| 198 |
|
---|
| 199 | if (!(1 <= portid && portid <= TNUM_SIOP)) {
|
---|
| 200 | return(E_ID); /* ãã¼ãçªå·ã®ãã§ã㯠*/
|
---|
| 201 | }
|
---|
| 202 |
|
---|
| 203 | q = get_sque(portid);
|
---|
| 204 | if (!(q->openflag)) { /* ãªã¼ãã³æ¸ã¿ãã®ãã§ã㯠*/
|
---|
| 205 | return(E_OBJ);
|
---|
| 206 | }
|
---|
| 207 |
|
---|
| 208 | wai_sem(q->ssemid);
|
---|
| 209 | for (i = 0; i < len; i++) {
|
---|
| 210 | while((sil_reb_mem((VP)(q->base+TADR_SFR_UC1_OFFSET)) & 0x2) == 0);
|
---|
| 211 | sil_wrb_mem((VP)(q->base+TADR_SFR_UTB_OFFSET), *buf++);
|
---|
| 212 | }
|
---|
| 213 | sig_sem(q->ssemid);
|
---|
| 214 | return(len);
|
---|
| 215 | }
|
---|
| 216 |
|
---|
| 217 | /*
|
---|
| 218 | * ã·ãªã¢ã«ãã¼ãããã®åä¿¡
|
---|
| 219 | */
|
---|
| 220 |
|
---|
| 221 | ER_UINT
|
---|
| 222 | serial_rea_dat(ID portid, char *buf, UINT len)
|
---|
| 223 | {
|
---|
| 224 | SQUE *q;
|
---|
| 225 | UINT i;
|
---|
| 226 |
|
---|
| 227 | if (!(1 <= portid && portid <= TNUM_SIOP)) {
|
---|
| 228 | return(E_ID); /* ãã¼ãçªå·ã®ãã§ã㯠*/
|
---|
| 229 | }
|
---|
| 230 |
|
---|
| 231 | q = get_sque(portid);
|
---|
| 232 | if (!(q->openflag)) { /* ãªã¼ãã³æ¸ã¿ãã®ãã§ã㯠*/
|
---|
| 233 | return(E_OBJ);
|
---|
| 234 | }
|
---|
| 235 |
|
---|
| 236 | for (i = 0; i < len; i++) {
|
---|
| 237 | if (queue_size(q) == 0)
|
---|
| 238 | wai_sem(q->rsemid);
|
---|
| 239 | else
|
---|
| 240 | pol_sem(q->rsemid);
|
---|
| 241 | _syscall(loc_cpu());
|
---|
| 242 | *buf++ = q->buffer[q->tail++];
|
---|
| 243 | if (q->tail >= q->size) {
|
---|
| 244 | q->tail = 0;
|
---|
| 245 | }
|
---|
| 246 | _syscall(unl_cpu());
|
---|
| 247 | }
|
---|
| 248 | return(len);
|
---|
| 249 | }
|
---|
| 250 |
|
---|
| 251 | /*
|
---|
| 252 | * ã·ãªã¢ã«ãã¼ãã®å¶å¾¡
|
---|
| 253 | */
|
---|
| 254 | ER
|
---|
| 255 | serial_ctl_por(ID portid, UINT ioctl)
|
---|
| 256 | {
|
---|
| 257 | return(E_OK);
|
---|
| 258 | }
|
---|
| 259 |
|
---|
| 260 | /*
|
---|
| 261 | * ã·ãªã¢ã«ãã¼ãç¶æ
|
---|
| 262 | ã®åç
|
---|
| 263 | §
|
---|
| 264 | */
|
---|
| 265 | ER
|
---|
| 266 | serial_ref_por(ID portid, T_SERIAL_RPOR *pk_rpor)
|
---|
| 267 | {
|
---|
| 268 | SQUE *q;
|
---|
| 269 |
|
---|
| 270 | if (sns_ctx()) { /* ã³ã³ããã¹ãã®ãã§ã㯠*/
|
---|
| 271 | return(E_CTX);
|
---|
| 272 | }
|
---|
| 273 | if (!(1 <= portid && portid <= TNUM_SIOP)) {
|
---|
| 274 | return(E_ID); /* ãã¼ãçªå·ã®ãã§ã㯠*/
|
---|
| 275 | }
|
---|
| 276 |
|
---|
| 277 | q = get_sque(portid);
|
---|
| 278 | if (!(q->openflag)) { /* ãªã¼ãã³æ¸ã¿ãã®ãã§ã㯠*/
|
---|
| 279 | return(E_OBJ);
|
---|
| 280 | }
|
---|
| 281 |
|
---|
| 282 | pk_rpor->reacnt = queue_size(q);
|
---|
| 283 | pk_rpor->wricnt = 0;
|
---|
| 284 | return(E_OK);
|
---|
| 285 | }
|
---|
| 286 |
|
---|
| 287 | /*
|
---|
| 288 | * ã·ãªã¢ã«ãã¼ãå²è¾¼ã¿ãµã¼ãã¹ã«ã¼ãã³
|
---|
| 289 | */
|
---|
| 290 |
|
---|
| 291 | void
|
---|
| 292 | serial_handler_in(ID portid)
|
---|
| 293 | {
|
---|
| 294 | SQUE *q;
|
---|
| 295 | int rdata; /* åä¿¡ãããã¡ */
|
---|
| 296 |
|
---|
| 297 | q = get_sque(portid);
|
---|
| 298 | if (queue_size(q) < q->size) {
|
---|
| 299 | rdata = sil_reb_mem((VP)(q->base+TADR_SFR_URB_OFFSET)); /* ãã¼ã¿åä¿¡ */
|
---|
| 300 | q->buffer[q->head++] = rdata;
|
---|
| 301 | if (q->head >= q->size)
|
---|
| 302 | q->head = 0;
|
---|
| 303 | isig_sem(q->rsemid);
|
---|
| 304 | }
|
---|
| 305 | }
|
---|
| 306 |
|
---|
| 307 | /*
|
---|
| 308 | * å²è¾¼ã¿ãã³ãã©
|
---|
| 309 | */
|
---|
| 310 |
|
---|
| 311 | void
|
---|
| 312 | serial_in_handler1(void)
|
---|
| 313 | {
|
---|
| 314 | serial_handler_in(1);
|
---|
| 315 | }
|
---|
| 316 |
|
---|
| 317 | void
|
---|
| 318 | serial_in_handler2(void)
|
---|
| 319 | {
|
---|
| 320 | serial_handler_in(2);
|
---|
| 321 | }
|
---|
| 322 |
|
---|