source: anotherchoice/tags/jsp-1.4.4-full-UTF8/config/ia32/pcat/pcat_com.c@ 26

Last change on this file since 26 was 26, checked in by ykominami, 10 years ago

initial

File size: 7.8 KB
Line 
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 */
102const 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};
116SIOPCB siopcb_table[TNUM_SIOP];
117
118Inline UB pcat_com_read(UH base, UH offset) {
119 return sil_reb_iop((VP)(base + offset));
120}
121
122Inline void pcat_com_write(UH base, UH offset, UB data) {
123 sil_wrb_iop((VP)(base + offset), data);
124}
125
126/*
127 * 文字を受信したか?
128 */
129Inline BOOL
130hw_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 */
141Inline BOOL
142hw_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
150SIOPCB *
151pcat_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
176void 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
195void
196pcat_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 */
207void
208pcat_com1_handler()
209{
210 pcat_com_isr(&siopcb_table[0]);
211}
212#if TNUM_PORT >= 2
213void
214pcat_com2_handler()
215{
216 pcat_com_isr(&siopcb_table[1]);
217}
218#endif
219
220SIOPCB *
221pcat_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 */
236void
237pcat_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 */
247INT
248pcat_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 */
262BOOL
263pcat_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
272void
273pcat_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
284void
285pcat_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
296void pcat_com_init(ID siopid) {
297 pcat_com_initialize();
298 pcat_com_set_mode(siopid);
299}
300
301void 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}
Note: See TracBrowser for help on using the repository browser.