Mercurial > ecos-v2_0-branch
annotate packages/io/serial/current/src/common/serial.c @ 115:6ed91473a1cd ecos-sw-2000-08-21
Merge from eCos master repository on 2000-08-21-22:40:54-BST
| author | jlarmour |
|---|---|
| date | Fri, 25 Aug 2000 17:32:38 +0000 |
| parents | 7f461c3a372c |
| children | 0c2b7be0d798 |
| rev | line source |
|---|---|
| 2 | 1 //========================================================================== |
| 2 // | |
| 3 // io/serial/common/serial.c | |
| 4 // | |
| 5 // High level serial driver | |
| 6 // | |
| 7 //========================================================================== | |
| 8 //####COPYRIGHTBEGIN#### | |
|
64
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
62
diff
changeset
|
9 // |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
62
diff
changeset
|
10 // ------------------------------------------- |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
62
diff
changeset
|
11 // The contents of this file are subject to the Red Hat eCos Public License |
|
66
bf00f99aec69
Merge from eCos master repository on 2000-02-02-19:16:44-GMT
jlarmour
parents:
64
diff
changeset
|
12 // Version 1.1 (the "License"); you may not use this file except in |
|
64
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
62
diff
changeset
|
13 // compliance with the License. You may obtain a copy of the License at |
|
66
bf00f99aec69
Merge from eCos master repository on 2000-02-02-19:16:44-GMT
jlarmour
parents:
64
diff
changeset
|
14 // http://www.redhat.com/ |
|
64
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
62
diff
changeset
|
15 // |
|
66
bf00f99aec69
Merge from eCos master repository on 2000-02-02-19:16:44-GMT
jlarmour
parents:
64
diff
changeset
|
16 // Software distributed under the License is distributed on an "AS IS" |
|
64
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
62
diff
changeset
|
17 // basis, WITHOUT WARRANTY OF ANY KIND, either express or implied. See the |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
62
diff
changeset
|
18 // License for the specific language governing rights and limitations under |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
62
diff
changeset
|
19 // the License. |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
62
diff
changeset
|
20 // |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
62
diff
changeset
|
21 // The Original Code is eCos - Embedded Configurable Operating System, |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
62
diff
changeset
|
22 // released September 30, 1998. |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
62
diff
changeset
|
23 // |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
62
diff
changeset
|
24 // The Initial Developer of the Original Code is Red Hat. |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
62
diff
changeset
|
25 // Portions created by Red Hat are |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
62
diff
changeset
|
26 // Copyright (C) 1998, 1999, 2000 Red Hat, Inc. |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
62
diff
changeset
|
27 // All Rights Reserved. |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
62
diff
changeset
|
28 // ------------------------------------------- |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
62
diff
changeset
|
29 // |
| 2 | 30 //####COPYRIGHTEND#### |
| 31 //========================================================================== | |
| 32 //#####DESCRIPTIONBEGIN#### | |
| 33 // | |
|
86
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
34 // Author(s): gthomas |
|
115
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
35 // Contributors: gthomas, grante, jlarmour, jskov |
|
86
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
36 // Date: 1999-02-04 |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
37 // Purpose: Top level serial driver |
| 2 | 38 // Description: |
| 39 // | |
| 40 //####DESCRIPTIONEND#### | |
| 41 // | |
| 42 //========================================================================== | |
| 43 | |
| 44 #include <pkgconf/io.h> | |
|
86
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
45 #include <pkgconf/io_serial.h> |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
46 |
| 2 | 47 #include <cyg/io/io.h> |
| 48 #include <cyg/io/devtab.h> | |
| 49 #include <cyg/io/serial.h> | |
| 50 #include <cyg/infra/diag.h> | |
| 51 | |
| 52 static Cyg_ErrNo serial_write(cyg_io_handle_t handle, const void *buf, cyg_uint32 *len); | |
| 53 static Cyg_ErrNo serial_read(cyg_io_handle_t handle, void *buf, cyg_uint32 *len); | |
|
115
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
54 static Cyg_ErrNo serial_select(cyg_io_handle_t handle, cyg_uint32 which, CYG_ADDRWORD info); |
| 2 | 55 static Cyg_ErrNo serial_get_config(cyg_io_handle_t handle, cyg_uint32 key, void *buf, cyg_uint32 *len); |
| 56 static Cyg_ErrNo serial_set_config(cyg_io_handle_t handle, cyg_uint32 key, const void *buf, cyg_uint32 *len); | |
| 57 | |
|
62
7a6ac9edc838
Merge from eCos master repository on 2000-01-24-19:43:49-GMT
jlarmour
parents:
20
diff
changeset
|
58 DEVIO_TABLE(cyg_io_serial_devio, |
| 2 | 59 serial_write, |
| 60 serial_read, | |
|
115
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
61 serial_select, |
| 2 | 62 serial_get_config, |
| 63 serial_set_config | |
| 64 ); | |
| 65 | |
| 66 static void serial_init(serial_channel *chan); | |
| 67 static void serial_xmt_char(serial_channel *chan); | |
| 68 static void serial_rcv_char(serial_channel *chan, unsigned char c); | |
|
115
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
69 #ifdef CYGOPT_IO_SERIAL_SUPPORT_LINE_STATUS |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
70 static void serial_indicate_status(serial_channel *chan, |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
71 cyg_serial_line_status_t *s); |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
72 #endif |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
73 #if CYGINT_IO_SERIAL_BLOCK_TRANSFER |
|
86
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
74 static bool serial_data_rcv_req(serial_channel *chan, int avail, |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
75 int* space_avail, unsigned char** space); |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
76 static void serial_data_rcv_done(serial_channel *chan); |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
77 static bool serial_data_xmt_req(serial_channel *chan, int space, |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
78 int* chars_avail, unsigned char** chars); |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
79 static void serial_data_xmt_done(serial_channel *chan); |
|
115
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
80 # ifdef CYGOPT_IO_SERIAL_FLOW_CONTROL_HW |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
81 SERIAL_CALLBACKS(cyg_io_serial_callbacks, |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
82 serial_init, |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
83 serial_xmt_char, |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
84 serial_rcv_char, |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
85 serial_data_rcv_req, |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
86 serial_data_rcv_done, |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
87 serial_data_xmt_req, |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
88 serial_data_xmt_done, |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
89 serial_indicate_status); |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
90 |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
91 # else |
|
86
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
92 SERIAL_CALLBACKS(cyg_io_serial_callbacks, |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
93 serial_init, |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
94 serial_xmt_char, |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
95 serial_rcv_char, |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
96 serial_data_rcv_req, |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
97 serial_data_rcv_done, |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
98 serial_data_xmt_req, |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
99 serial_data_xmt_done); |
|
115
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
100 # endif |
|
86
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
101 #else |
|
115
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
102 # ifdef CYGOPT_IO_SERIAL_SUPPORT_LINE_STATUS |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
103 SERIAL_CALLBACKS(cyg_io_serial_callbacks, |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
104 serial_init, |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
105 serial_xmt_char, |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
106 serial_rcv_char, |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
107 serial_indicate_status); |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
108 # else |
|
62
7a6ac9edc838
Merge from eCos master repository on 2000-01-24-19:43:49-GMT
jlarmour
parents:
20
diff
changeset
|
109 SERIAL_CALLBACKS(cyg_io_serial_callbacks, |
| 2 | 110 serial_init, |
| 111 serial_xmt_char, | |
| 112 serial_rcv_char); | |
|
115
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
113 # endif |
|
86
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
114 #endif |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
115 |
|
115
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
116 // --------------------------------------------------------------------------- |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
117 |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
118 #ifdef CYGPKG_IO_SERIAL_FLOW_CONTROL |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
119 |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
120 static __inline__ void |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
121 throttle_tx( serial_channel *chan ) |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
122 { |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
123 chan->flow_desc.flags |= CYG_SERIAL_FLOW_OUT_THROTTLED; |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
124 // the throttling itself occurs in the serial_xmt_char() callback |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
125 } |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
126 |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
127 static __inline__ void |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
128 restart_tx( serial_channel *chan ) |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
129 { |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
130 serial_funs *funs = chan->funs; |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
131 |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
132 chan->flow_desc.flags &= ~CYG_SERIAL_FLOW_OUT_THROTTLED; |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
133 |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
134 #ifdef CYGPKG_IO_SERIAL_SELECT_SUPPORT |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
135 // See if there is now enough room to say it is available |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
136 // for writing |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
137 { |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
138 cbuf_t *cbuf = &chan->out_cbuf; |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
139 int space; |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
140 |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
141 space = cbuf->len - cbuf->nb; |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
142 if (space >= cbuf->low_water) |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
143 cyg_selwakeup( &cbuf->selinfo ); |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
144 } |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
145 #endif |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
146 if ( chan->out_cbuf.nb > 0 ) |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
147 (funs->start_xmit)(chan); |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
148 } |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
149 |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
150 static __inline__ void |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
151 throttle_rx( serial_channel *chan, cyg_bool force ) |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
152 { |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
153 serial_funs *funs = chan->funs; |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
154 |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
155 chan->flow_desc.flags |= CYG_SERIAL_FLOW_IN_THROTTLED; |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
156 #ifdef CYGOPT_IO_SERIAL_FLOW_CONTROL_SOFTWARE |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
157 // send an xoff |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
158 if ( force || chan->config.flags & CYGNUM_SERIAL_FLOW_XONXOFF_RX ) { |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
159 chan->flow_desc.xchar = CYGDAT_IO_SERIAL_FLOW_CONTROL_XOFF_CHAR; |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
160 // Make sure xmit is running so we can send it |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
161 (funs->start_xmit)(chan); |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
162 } |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
163 #endif |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
164 #ifdef CYGOPT_IO_SERIAL_FLOW_CONTROL_HW |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
165 { |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
166 cyg_uint32 i=1; |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
167 cyg_uint32 len = sizeof(i); |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
168 |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
169 // set hardware flow control - don't care if it fails |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
170 if ( force || (chan->config.flags & CYGNUM_SERIAL_FLOW_RTSCTS_RX) || |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
171 (chan->config.flags & CYGNUM_SERIAL_FLOW_DSRDTR_RX) ) |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
172 (funs->set_config)(chan, |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
173 CYG_IO_SET_CONFIG_SERIAL_HW_RX_FLOW_THROTTLE, |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
174 &i, &len); |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
175 } |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
176 #endif |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
177 } |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
178 |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
179 static __inline__ void |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
180 restart_rx( serial_channel *chan, cyg_bool force ) |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
181 { |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
182 serial_funs *funs = chan->funs; |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
183 |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
184 chan->flow_desc.flags &= ~CYG_SERIAL_FLOW_IN_THROTTLED; |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
185 #ifdef CYGOPT_IO_SERIAL_FLOW_CONTROL_SOFTWARE |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
186 // send an xon |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
187 if ( force || chan->config.flags & CYGNUM_SERIAL_FLOW_XONXOFF_RX ) { |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
188 chan->flow_desc.xchar = CYGDAT_IO_SERIAL_FLOW_CONTROL_XON_CHAR; |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
189 (funs->start_xmit)(chan); // Make sure xmit is running so we can send it |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
190 } |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
191 #endif |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
192 #ifdef CYGOPT_IO_SERIAL_FLOW_CONTROL_HW |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
193 { |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
194 cyg_uint32 i=0; |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
195 cyg_uint32 len = sizeof(i); |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
196 |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
197 // set hardware flow control - don't care if it fails |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
198 if ( force || (chan->config.flags & CYGNUM_SERIAL_FLOW_RTSCTS_RX) || |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
199 (chan->config.flags & CYGNUM_SERIAL_FLOW_DSRDTR_RX) ) |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
200 (funs->set_config)(chan, |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
201 CYG_IO_SET_CONFIG_SERIAL_HW_RX_FLOW_THROTTLE, |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
202 &i, &len); |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
203 } |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
204 #endif |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
205 } |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
206 |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
207 #endif |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
208 |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
209 // --------------------------------------------------------------------------- |
| 2 | 210 |
| 211 static void | |
| 212 serial_init(serial_channel *chan) | |
| 213 { | |
| 214 if (chan->init) return; | |
| 215 if (chan->out_cbuf.len != 0) { | |
| 216 #ifdef CYGDBG_IO_INIT | |
| 217 diag_printf("Set output buffer - buf: %x len: %d\n", chan->out_cbuf.data, chan->out_cbuf.len); | |
| 218 #endif | |
| 219 chan->out_cbuf.waiting = false; | |
| 220 chan->out_cbuf.abort = false; | |
|
86
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
221 #ifdef CYGOPT_IO_SERIAL_SUPPORT_NONBLOCKING |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
222 chan->out_cbuf.blocking = true; |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
223 #endif |
| 2 | 224 chan->out_cbuf.pending = 0; |
| 225 cyg_drv_mutex_init(&chan->out_cbuf.lock); | |
| 226 cyg_drv_cond_init(&chan->out_cbuf.wait, &chan->out_cbuf.lock); | |
| 227 chan->out_cbuf.low_water = chan->out_cbuf.len / 4; | |
|
115
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
228 #ifdef CYGPKG_IO_SERIAL_SELECT_SUPPORT |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
229 cyg_selinit( &chan->out_cbuf.selinfo ); |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
230 #endif |
| 2 | 231 } |
| 232 if (chan->in_cbuf.len != 0) { | |
|
115
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
233 cbuf_t *cbuf = &chan->in_cbuf; |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
234 |
| 2 | 235 #ifdef CYGDBG_IO_INIT |
|
115
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
236 diag_printf("Set input buffer - buf: %x len: %d\n", cbuf->data, cbuf->len); |
| 2 | 237 #endif |
|
115
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
238 cbuf->waiting = false; |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
239 cbuf->abort = false; |
|
86
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
240 #ifdef CYGOPT_IO_SERIAL_SUPPORT_NONBLOCKING |
|
115
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
241 cbuf->blocking = true; |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
242 #endif |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
243 #ifdef CYGPKG_IO_SERIAL_SELECT_SUPPORT |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
244 cyg_selinit( &cbuf->selinfo ); |
|
86
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
245 #endif |
|
115
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
246 #ifdef CYGPKG_IO_SERIAL_FLOW_CONTROL |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
247 cbuf->low_water = |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
248 (CYGNUM_IO_SERIAL_FLOW_CONTROL_LOW_WATER_PERCENT * cbuf->len) / 100; |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
249 cbuf->high_water = |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
250 (CYGNUM_IO_SERIAL_FLOW_CONTROL_HIGH_WATER_PERCENT * cbuf->len) / 100; |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
251 # ifdef CYGOPT_IO_SERIAL_FLOW_CONTROL_SOFTWARE |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
252 // But make sure it is at least 35 below buffer size, to allow |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
253 // for 16 byte fifos, twice, plus some latency before s/w flow |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
254 // control can kick in. This doesn't apply to h/w flow control |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
255 // as it is near-instaneous |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
256 if ( (cbuf->len - cbuf->high_water) < 35 ) |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
257 cbuf->high_water = cbuf->len - 35; |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
258 // and just in case... |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
259 if ( cbuf->high_water <= 0 ) |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
260 cbuf->high_water = 1; |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
261 if ( cbuf->low_water > cbuf->high_water ) |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
262 cbuf->low_water = cbuf->high_water; |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
263 # endif |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
264 #endif |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
265 cyg_drv_mutex_init(&cbuf->lock); |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
266 cyg_drv_cond_init(&cbuf->wait, &cbuf->lock); |
| 2 | 267 } |
|
115
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
268 #ifdef CYGOPT_IO_SERIAL_SUPPORT_LINE_STATUS |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
269 chan->status_callback = NULL; |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
270 #endif |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
271 |
| 2 | 272 chan->init = true; |
| 273 } | |
| 274 | |
|
115
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
275 // --------------------------------------------------------------------------- |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
276 // FIXME:@@@ Throughout this file there are uses of cyg_drv_cond_signal and |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
277 // cyg_drv_cond_broadcast. Does it matter which? -Jifl |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
278 |
| 2 | 279 static Cyg_ErrNo |
| 280 serial_write(cyg_io_handle_t handle, const void *_buf, cyg_uint32 *len) | |
| 281 { | |
| 282 cyg_devtab_entry_t *t = (cyg_devtab_entry_t *)handle; | |
| 283 serial_channel *chan = (serial_channel *)t->priv; | |
| 284 serial_funs *funs = chan->funs; | |
| 285 cyg_int32 size = *len; | |
| 286 cyg_uint8 *buf = (cyg_uint8 *)_buf; | |
| 287 int next; | |
| 288 cbuf_t *cbuf = &chan->out_cbuf; | |
| 289 Cyg_ErrNo res = ENOERR; | |
|
20
5f5102441818
Merge from eCos master repository on 1999-07-02-23:17:07-BST
jlarmour
parents:
4
diff
changeset
|
290 |
|
115
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
291 cyg_drv_mutex_lock(&cbuf->lock); |
|
4
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
292 cbuf->abort = false; |
|
86
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
293 |
| 2 | 294 if (cbuf->len == 0) { |
| 295 // Non interrupt driven (i.e. polled) operation | |
| 296 while (size-- > 0) { | |
|
115
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
297 #ifdef CYGPKG_IO_SERIAL_FLOW_CONTROL |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
298 while ( ( 0 == (chan->flow_desc.flags & CYG_SERIAL_FLOW_OUT_THROTTLED) ) && |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
299 ((funs->putc)(chan, *buf) == false) ) |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
300 ; // Ignore full, keep trying |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
301 #else |
| 2 | 302 while ((funs->putc)(chan, *buf) == false) ; // Ignore full, keep trying |
|
115
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
303 #endif |
| 2 | 304 buf++; |
| 305 } | |
| 306 } else { | |
| 307 cyg_drv_dsr_lock(); // Avoid race condition testing pointers | |
| 308 while (size > 0) { | |
| 309 next = cbuf->put + 1; | |
| 310 if (next == cbuf->len) next = 0; | |
|
115
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
311 if (cbuf->nb == cbuf->len) { |
| 2 | 312 cbuf->waiting = true; |
| 313 // Buffer full - wait for space | |
|
115
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
314 #ifdef CYGPKG_IO_SERIAL_FLOW_CONTROL |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
315 if ( 0 == (chan->flow_desc.flags & CYG_SERIAL_FLOW_OUT_THROTTLED) ) |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
316 #endif |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
317 (funs->start_xmit)(chan); // Make sure xmit is running |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
318 |
|
86
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
319 // Check flag: 'start_xmit' may have obviated the need to wait :-) |
|
62
7a6ac9edc838
Merge from eCos master repository on 2000-01-24-19:43:49-GMT
jlarmour
parents:
20
diff
changeset
|
320 if (cbuf->waiting) { |
|
86
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
321 #ifdef CYGOPT_IO_SERIAL_SUPPORT_NONBLOCKING |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
322 // Optionally return if configured for non-blocking mode. |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
323 if (!cbuf->blocking) { |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
324 *len -= size; // number of characters actually sent |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
325 cbuf->waiting = false; |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
326 res = -EAGAIN; |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
327 break; |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
328 } |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
329 #endif // CYGOPT_IO_SERIAL_SUPPORT_NONBLOCKING |
|
62
7a6ac9edc838
Merge from eCos master repository on 2000-01-24-19:43:49-GMT
jlarmour
parents:
20
diff
changeset
|
330 cbuf->pending += size; // Have this much more to send [eventually] |
|
115
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
331 if( !cyg_drv_cond_wait(&cbuf->wait) ) |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
332 cbuf->abort = true; |
|
62
7a6ac9edc838
Merge from eCos master repository on 2000-01-24-19:43:49-GMT
jlarmour
parents:
20
diff
changeset
|
333 cbuf->pending -= size; |
|
7a6ac9edc838
Merge from eCos master repository on 2000-01-24-19:43:49-GMT
jlarmour
parents:
20
diff
changeset
|
334 } |
| 2 | 335 if (cbuf->abort) { |
| 336 // Give up! | |
|
86
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
337 *len -= size; // number of characters actually sent |
| 2 | 338 cbuf->abort = false; |
| 339 cbuf->waiting = false; | |
| 340 res = -EINTR; | |
| 341 break; | |
| 342 } | |
| 343 } else { | |
| 344 cbuf->data[cbuf->put++] = *buf++; | |
| 345 cbuf->put = next; | |
|
115
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
346 cbuf->nb++; |
| 2 | 347 size--; // Only count if actually sent! |
| 348 } | |
| 349 } | |
|
115
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
350 #ifdef CYGPKG_IO_SERIAL_FLOW_CONTROL |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
351 if ( 0 == (chan->flow_desc.flags & CYG_SERIAL_FLOW_OUT_THROTTLED) ) |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
352 #endif |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
353 (funs->start_xmit)(chan); // Start output as necessary |
| 2 | 354 cyg_drv_dsr_unlock(); |
| 355 } | |
| 356 cyg_drv_mutex_unlock(&cbuf->lock); | |
| 357 return res; | |
| 358 } | |
| 359 | |
|
115
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
360 |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
361 // --------------------------------------------------------------------------- |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
362 |
| 2 | 363 static Cyg_ErrNo |
| 364 serial_read(cyg_io_handle_t handle, void *_buf, cyg_uint32 *len) | |
| 365 { | |
| 366 cyg_devtab_entry_t *t = (cyg_devtab_entry_t *)handle; | |
| 367 serial_channel *chan = (serial_channel *)t->priv; | |
| 368 serial_funs *funs = chan->funs; | |
| 369 cyg_uint8 *buf = (cyg_uint8 *)_buf; | |
| 370 cyg_int32 size = 0; | |
| 371 cbuf_t *cbuf = &chan->in_cbuf; | |
| 372 Cyg_ErrNo res = ENOERR; | |
|
20
5f5102441818
Merge from eCos master repository on 1999-07-02-23:17:07-BST
jlarmour
parents:
4
diff
changeset
|
373 #ifdef XX_CYGDBG_DIAG_BUF |
|
5f5102441818
Merge from eCos master repository on 1999-07-02-23:17:07-BST
jlarmour
parents:
4
diff
changeset
|
374 extern int enable_diag_uart; |
|
5f5102441818
Merge from eCos master repository on 1999-07-02-23:17:07-BST
jlarmour
parents:
4
diff
changeset
|
375 int _enable = enable_diag_uart; |
|
5f5102441818
Merge from eCos master repository on 1999-07-02-23:17:07-BST
jlarmour
parents:
4
diff
changeset
|
376 int _time, _stime; |
|
5f5102441818
Merge from eCos master repository on 1999-07-02-23:17:07-BST
jlarmour
parents:
4
diff
changeset
|
377 externC cyg_tick_count_t cyg_current_time(void); |
|
5f5102441818
Merge from eCos master repository on 1999-07-02-23:17:07-BST
jlarmour
parents:
4
diff
changeset
|
378 #endif // CYGDBG_DIAG_BUF |
|
5f5102441818
Merge from eCos master repository on 1999-07-02-23:17:07-BST
jlarmour
parents:
4
diff
changeset
|
379 |
|
115
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
380 cyg_drv_mutex_lock(&cbuf->lock); |
|
4
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
381 cbuf->abort = false; |
|
86
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
382 |
| 2 | 383 if (cbuf->len == 0) { |
| 384 // Non interrupt driven (i.e. polled) operation | |
| 385 while (size++ < *len) { | |
|
115
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
386 cyg_uint8 c = (funs->getc)(chan); |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
387 #ifdef CYGOPT_IO_SERIAL_FLOW_CONTROL_SOFTWARE |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
388 // for software flow control, if the driver returns one of the |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
389 // characters we act on it and then drop it (the app must not |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
390 // see it) |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
391 if ( chan->config.flags & CYGNUM_SERIAL_FLOW_XONXOFF_TX ) { |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
392 if ( c == CYGDAT_IO_SERIAL_FLOW_CONTROL_XOFF_CHAR ) { |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
393 throttle_tx( chan ); |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
394 } else if ( c == CYGDAT_IO_SERIAL_FLOW_CONTROL_XON_CHAR ) { |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
395 restart_tx( chan ); |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
396 } |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
397 else |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
398 *buf++ = c; |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
399 } |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
400 else |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
401 *buf++ = c; |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
402 #else |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
403 *buf++ = c; |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
404 #endif |
| 2 | 405 } |
| 406 } else { | |
| 407 cyg_drv_dsr_lock(); // Avoid races | |
| 408 while (size < *len) { | |
|
115
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
409 if (cbuf->nb > 0) { |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
410 #ifdef CYGPKG_IO_SERIAL_FLOW_CONTROL |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
411 if ( (cbuf->nb <= cbuf->low_water) && |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
412 (chan->flow_desc.flags & CYG_SERIAL_FLOW_IN_THROTTLED) ) |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
413 restart_rx( chan, false ); |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
414 #endif |
| 2 | 415 *buf++ = cbuf->data[cbuf->get]; |
| 416 if (++cbuf->get == cbuf->len) cbuf->get = 0; | |
|
115
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
417 cbuf->nb--; |
| 2 | 418 size++; |
| 419 } else { | |
|
86
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
420 #ifdef CYGOPT_IO_SERIAL_SUPPORT_NONBLOCKING |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
421 if (!cbuf->blocking) { |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
422 *len = size; // characters actually read |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
423 res = -EAGAIN; |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
424 break; |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
425 } |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
426 #endif // CYGOPT_IO_SERIAL_SUPPORT_NONBLOCKING |
| 2 | 427 cbuf->waiting = true; |
|
20
5f5102441818
Merge from eCos master repository on 1999-07-02-23:17:07-BST
jlarmour
parents:
4
diff
changeset
|
428 #ifdef XX_CYGDBG_DIAG_BUF |
|
115
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
429 enable_diag_uart = 0; |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
430 HAL_CLOCK_READ(&_time); |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
431 _stime = (int)cyg_current_time(); |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
432 diag_printf("READ wait - get: %d, put: %d, time: %x.%x\n", cbuf->get, cbuf->put, _stime, _time); |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
433 enable_diag_uart = _enable; |
|
20
5f5102441818
Merge from eCos master repository on 1999-07-02-23:17:07-BST
jlarmour
parents:
4
diff
changeset
|
434 #endif // CYGDBG_DIAG_BUF |
|
115
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
435 if( !cyg_drv_cond_wait(&cbuf->wait) ) |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
436 cbuf->abort = true; |
|
20
5f5102441818
Merge from eCos master repository on 1999-07-02-23:17:07-BST
jlarmour
parents:
4
diff
changeset
|
437 #ifdef XX_CYGDBG_DIAG_BUF |
|
115
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
438 enable_diag_uart = 0; |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
439 HAL_CLOCK_READ(&_time); |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
440 _stime = (int)cyg_current_time(); |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
441 diag_printf("READ continue - get: %d, put: %d, time: %x.%x\n", cbuf->get, cbuf->put, _stime, _time); |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
442 enable_diag_uart = _enable; |
|
20
5f5102441818
Merge from eCos master repository on 1999-07-02-23:17:07-BST
jlarmour
parents:
4
diff
changeset
|
443 #endif // CYGDBG_DIAG_BUF |
| 2 | 444 if (cbuf->abort) { |
| 445 // Give up! | |
|
86
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
446 *len = size; // characters actually read |
| 2 | 447 cbuf->abort = false; |
| 448 cbuf->waiting = false; | |
| 449 res = -EINTR; | |
| 450 break; | |
| 451 } | |
| 452 } | |
| 453 } | |
| 454 cyg_drv_dsr_unlock(); | |
| 455 } | |
|
82
6736c52df507
Merge from eCos master repository on 2000-04-14-13:35:46-BST
jlarmour
parents:
66
diff
changeset
|
456 #ifdef XX_CYGDBG_DIAG_BUF |
|
20
5f5102441818
Merge from eCos master repository on 1999-07-02-23:17:07-BST
jlarmour
parents:
4
diff
changeset
|
457 cyg_drv_isr_lock(); |
|
82
6736c52df507
Merge from eCos master repository on 2000-04-14-13:35:46-BST
jlarmour
parents:
66
diff
changeset
|
458 enable_diag_uart = 0; |
|
6736c52df507
Merge from eCos master repository on 2000-04-14-13:35:46-BST
jlarmour
parents:
66
diff
changeset
|
459 HAL_CLOCK_READ(&_time); |
|
6736c52df507
Merge from eCos master repository on 2000-04-14-13:35:46-BST
jlarmour
parents:
66
diff
changeset
|
460 _stime = (int)cyg_current_time(); |
|
6736c52df507
Merge from eCos master repository on 2000-04-14-13:35:46-BST
jlarmour
parents:
66
diff
changeset
|
461 diag_printf("READ done - size: %d, len: %d, time: %x.%x\n", size, *len, _stime, _time); |
|
6736c52df507
Merge from eCos master repository on 2000-04-14-13:35:46-BST
jlarmour
parents:
66
diff
changeset
|
462 enable_diag_uart = _enable; |
|
6736c52df507
Merge from eCos master repository on 2000-04-14-13:35:46-BST
jlarmour
parents:
66
diff
changeset
|
463 cyg_drv_isr_unlock(); |
|
20
5f5102441818
Merge from eCos master repository on 1999-07-02-23:17:07-BST
jlarmour
parents:
4
diff
changeset
|
464 #endif // CYGDBG_DIAG_BUF |
| 2 | 465 cyg_drv_mutex_unlock(&cbuf->lock); |
| 466 return res; | |
| 467 } | |
| 468 | |
|
115
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
469 |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
470 // --------------------------------------------------------------------------- |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
471 |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
472 static cyg_bool |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
473 serial_select(cyg_io_handle_t handle, cyg_uint32 which, CYG_ADDRWORD info) |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
474 { |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
475 #ifdef CYGPKG_IO_SERIAL_SELECT_SUPPORT |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
476 |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
477 cyg_devtab_entry_t *t = (cyg_devtab_entry_t *)handle; |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
478 serial_channel *chan = (serial_channel *)t->priv; |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
479 |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
480 |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
481 switch( which ) |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
482 { |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
483 case CYG_FREAD: |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
484 { |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
485 cbuf_t *cbuf = &chan->in_cbuf; |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
486 |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
487 // Check for data in the input buffer. If there is none, |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
488 // register the select operation, otherwise return true. |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
489 |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
490 if( cbuf->nb == 0 ) |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
491 cyg_selrecord( info, &cbuf->selinfo ); |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
492 else return true; |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
493 } |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
494 break; |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
495 |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
496 case CYG_FWRITE: |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
497 { |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
498 // Check for space in the output buffer. If there is none, |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
499 // register the select operation, otherwise return true. |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
500 |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
501 cbuf_t *cbuf = &chan->out_cbuf; |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
502 int space = cbuf->len - cbuf->nb; |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
503 #ifdef CYGPKG_IO_SERIAL_FLOW_CONTROL |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
504 if ( (space < cbuf->low_water) || |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
505 (chan->flow_desc.flags & CYG_SERIAL_FLOW_OUT_THROTTLED) ) |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
506 cyg_selrecord( info, &cbuf->selinfo ); |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
507 #else |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
508 if (space < cbuf->low_water) |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
509 cyg_selrecord( info, &cbuf->selinfo ); |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
510 #endif |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
511 else return true; |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
512 } |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
513 break; |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
514 |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
515 case 0: // exceptions - none supported |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
516 break; |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
517 } |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
518 return false; |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
519 #else |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
520 |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
521 // With no select support, we simply return true. |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
522 return true; |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
523 #endif |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
524 } |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
525 |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
526 |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
527 // --------------------------------------------------------------------------- |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
528 |
| 2 | 529 static Cyg_ErrNo |
| 530 serial_get_config(cyg_io_handle_t handle, cyg_uint32 key, void *xbuf, cyg_uint32 *len) | |
| 531 { | |
| 532 cyg_devtab_entry_t *t = (cyg_devtab_entry_t *)handle; | |
| 533 serial_channel *chan = (serial_channel *)t->priv; | |
| 534 cyg_serial_info_t *buf = (cyg_serial_info_t *)xbuf; | |
| 535 Cyg_ErrNo res = ENOERR; | |
|
86
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
536 cbuf_t *out_cbuf = &chan->out_cbuf; |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
537 cbuf_t *in_cbuf = &chan->in_cbuf; |
| 2 | 538 serial_funs *funs = chan->funs; |
| 539 | |
| 540 switch (key) { | |
| 541 case CYG_IO_GET_CONFIG_SERIAL_INFO: | |
| 542 if (*len < sizeof(cyg_serial_info_t)) { | |
| 543 return -EINVAL; | |
| 544 } | |
| 545 *buf = chan->config; | |
| 546 *len = sizeof(chan->config); | |
| 547 break; | |
|
86
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
548 |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
549 case CYG_IO_GET_CONFIG_SERIAL_BUFFER_INFO: |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
550 // return rx/tx buffer sizes and counts |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
551 { |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
552 cyg_serial_buf_info_t *p; |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
553 if (*len < sizeof(cyg_serial_buf_info_t)) |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
554 return -EINVAL; |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
555 |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
556 *len = sizeof(cyg_serial_buf_info_t); |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
557 p = (cyg_serial_buf_info_t *)xbuf; |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
558 |
|
88
afdeb44241de
Merge from eCos master repository on 2000-05-12-07:47:04-BST
jlarmour
parents:
86
diff
changeset
|
559 p->rx_bufsize = in_cbuf->len; |
|
115
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
560 if (p->rx_bufsize) |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
561 p->rx_count = in_cbuf->nb; |
|
86
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
562 else |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
563 p->rx_count = 0; |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
564 |
|
88
afdeb44241de
Merge from eCos master repository on 2000-05-12-07:47:04-BST
jlarmour
parents:
86
diff
changeset
|
565 p->tx_bufsize = out_cbuf->len; |
|
115
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
566 if (p->tx_bufsize) |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
567 p->tx_count = out_cbuf->nb; |
|
86
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
568 else |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
569 p->tx_count = 0; |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
570 } |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
571 break; |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
572 |
| 2 | 573 case CYG_IO_GET_CONFIG_SERIAL_OUTPUT_DRAIN: |
| 574 // Wait for any pending output to complete | |
|
86
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
575 if (out_cbuf->len == 0) break; // Nothing to do if not buffered |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
576 cyg_drv_mutex_lock(&out_cbuf->lock); // Stop any further output processing |
| 2 | 577 cyg_drv_dsr_lock(); |
|
115
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
578 while (out_cbuf->pending || (out_cbuf->nb > 0)) { |
|
86
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
579 out_cbuf->waiting = true; |
|
115
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
580 if(!cyg_drv_cond_wait(&out_cbuf->wait) ) |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
581 res = -EINTR; |
| 2 | 582 } |
| 583 cyg_drv_dsr_unlock(); | |
|
86
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
584 cyg_drv_mutex_unlock(&out_cbuf->lock); |
| 2 | 585 break; |
|
86
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
586 |
| 2 | 587 case CYG_IO_GET_CONFIG_SERIAL_INPUT_FLUSH: |
| 588 // Flush any buffered input | |
|
86
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
589 if (in_cbuf->len == 0) break; // Nothing to do if not buffered |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
590 cyg_drv_mutex_lock(&in_cbuf->lock); // Stop any further input processing |
| 2 | 591 cyg_drv_dsr_lock(); |
|
86
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
592 if (in_cbuf->waiting) { |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
593 in_cbuf->abort = true; |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
594 cyg_drv_cond_signal(&in_cbuf->wait); |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
595 in_cbuf->waiting = false; |
| 2 | 596 } |
|
115
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
597 in_cbuf->get = in_cbuf->put = in_cbuf->nb = 0; // Flush buffered input |
| 2 | 598 cyg_drv_dsr_unlock(); |
|
86
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
599 cyg_drv_mutex_unlock(&in_cbuf->lock); |
| 2 | 600 break; |
|
86
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
601 |
| 2 | 602 case CYG_IO_GET_CONFIG_SERIAL_ABORT: |
| 603 // Abort any outstanding I/O, including blocked reads | |
| 604 // Caution - assumed to be called from 'timeout' (i.e. DSR) code | |
|
86
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
605 if (in_cbuf->len != 0) { |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
606 in_cbuf->abort = true; |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
607 cyg_drv_cond_signal(&in_cbuf->wait); |
| 2 | 608 } |
|
86
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
609 if (out_cbuf->len != 0) { |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
610 out_cbuf->abort = true; |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
611 cyg_drv_cond_signal(&out_cbuf->wait); |
| 2 | 612 } |
| 613 break; | |
|
86
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
614 |
| 2 | 615 case CYG_IO_GET_CONFIG_SERIAL_OUTPUT_FLUSH: |
| 616 // Throw away any pending output | |
|
86
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
617 if (out_cbuf->len == 0) break; // Nothing to do if not buffered |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
618 cyg_drv_mutex_lock(&out_cbuf->lock); // Stop any further output processing |
| 2 | 619 cyg_drv_dsr_lock(); |
|
115
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
620 if (out_cbuf->nb > 0) { |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
621 out_cbuf->get = out_cbuf->put = out_cbuf->nb = 0; // Empties queue! |
| 2 | 622 (funs->stop_xmit)(chan); // Done with transmit |
| 623 } | |
|
86
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
624 if (out_cbuf->waiting) { |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
625 out_cbuf->abort = true; |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
626 cyg_drv_cond_signal(&out_cbuf->wait); |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
627 out_cbuf->waiting = false; |
| 2 | 628 } |
| 629 cyg_drv_dsr_unlock(); | |
|
86
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
630 cyg_drv_mutex_unlock(&out_cbuf->lock); |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
631 break; |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
632 |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
633 #ifdef CYGOPT_IO_SERIAL_SUPPORT_NONBLOCKING |
|
115
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
634 case CYG_IO_GET_CONFIG_READ_BLOCKING: |
|
86
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
635 if (*len < sizeof(cyg_uint32)) { |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
636 return -EINVAL; |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
637 } |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
638 *(cyg_uint32*)xbuf = (in_cbuf->blocking) ? 1 : 0; |
| 2 | 639 break; |
|
86
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
640 |
|
115
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
641 case CYG_IO_GET_CONFIG_WRITE_BLOCKING: |
|
86
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
642 if (*len < sizeof(cyg_uint32)) { |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
643 return -EINVAL; |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
644 } |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
645 *(cyg_uint32*)xbuf = (out_cbuf->blocking) ? 1 : 0; |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
646 break; |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
647 #endif // CYGOPT_IO_SERIAL_SUPPORT_NONBLOCKING |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
648 |
| 2 | 649 default: |
| 650 res = -EINVAL; | |
| 651 } | |
| 652 return res; | |
| 653 } | |
| 654 | |
|
115
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
655 |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
656 // --------------------------------------------------------------------------- |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
657 |
| 2 | 658 static Cyg_ErrNo |
| 659 serial_set_config(cyg_io_handle_t handle, cyg_uint32 key, const void *xbuf, cyg_uint32 *len) | |
| 660 { | |
| 661 Cyg_ErrNo res = ENOERR; | |
| 662 cyg_devtab_entry_t *t = (cyg_devtab_entry_t *)handle; | |
| 663 serial_channel *chan = (serial_channel *)t->priv; | |
|
86
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
664 #ifdef CYGOPT_IO_SERIAL_SUPPORT_NONBLOCKING |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
665 cbuf_t *out_cbuf = &chan->out_cbuf; |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
666 cbuf_t *in_cbuf = &chan->in_cbuf; |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
667 #endif |
| 2 | 668 serial_funs *funs = chan->funs; |
| 669 | |
| 670 switch (key) { | |
|
86
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
671 #ifdef CYGOPT_IO_SERIAL_SUPPORT_NONBLOCKING |
|
115
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
672 case CYG_IO_SET_CONFIG_READ_BLOCKING: |
|
86
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
673 if (*len < sizeof(cyg_uint32) || 0 == in_cbuf->len) { |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
674 return -EINVAL; |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
675 } |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
676 in_cbuf->blocking = (1 == *(cyg_uint32*)xbuf) ? true : false; |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
677 break; |
|
115
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
678 case CYG_IO_SET_CONFIG_WRITE_BLOCKING: |
|
86
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
679 if (*len < sizeof(cyg_uint32) || 0 == out_cbuf->len) { |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
680 return -EINVAL; |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
681 } |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
682 out_cbuf->blocking = (1 == *(cyg_uint32*)xbuf) ? true : false; |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
683 break; |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
684 #endif // CYGOPT_IO_SERIAL_SUPPORT_NONBLOCKING |
|
115
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
685 |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
686 #ifdef CYGPKG_IO_SERIAL_FLOW_CONTROL |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
687 case CYG_IO_SET_CONFIG_SERIAL_FLOW_CONTROL_METHOD: |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
688 { |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
689 cyg_uint32 *f = (cyg_uint32 *)xbuf; |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
690 |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
691 if (*len < sizeof(*f)) |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
692 return -EINVAL; |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
693 |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
694 cyg_drv_dsr_lock(); |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
695 |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
696 chan->config.flags &= ~(CYGNUM_SERIAL_FLOW_XONXOFF_RX| |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
697 CYGNUM_SERIAL_FLOW_XONXOFF_TX| |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
698 CYGNUM_SERIAL_FLOW_RTSCTS_RX| |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
699 CYGNUM_SERIAL_FLOW_RTSCTS_TX| |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
700 CYGNUM_SERIAL_FLOW_DSRDTR_RX| |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
701 CYGNUM_SERIAL_FLOW_DSRDTR_TX); |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
702 chan->config.flags |= (*f & ( |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
703 #ifdef CYGOPT_IO_SERIAL_FLOW_CONTROL_SOFTWARE |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
704 CYGNUM_SERIAL_FLOW_XONXOFF_RX| |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
705 CYGNUM_SERIAL_FLOW_XONXOFF_TX| |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
706 #endif |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
707 #ifdef CYGOPT_IO_SERIAL_FLOW_CONTROL_HW |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
708 CYGNUM_SERIAL_FLOW_RTSCTS_RX| |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
709 CYGNUM_SERIAL_FLOW_RTSCTS_TX| |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
710 CYGNUM_SERIAL_FLOW_DSRDTR_RX| |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
711 CYGNUM_SERIAL_FLOW_DSRDTR_TX| |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
712 #endif |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
713 0)); |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
714 #ifdef CYGOPT_IO_SERIAL_FLOW_CONTROL_HW |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
715 // up to hardware driver to clear flags if rejected |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
716 res = (funs->set_config)(chan, |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
717 CYG_IO_SET_CONFIG_SERIAL_HW_FLOW_CONFIG, |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
718 NULL, NULL); |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
719 #endif |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
720 cyg_drv_dsr_unlock(); |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
721 } |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
722 break; |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
723 |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
724 case CYG_IO_SET_CONFIG_SERIAL_FLOW_CONTROL_FORCE: |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
725 { |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
726 cyg_uint32 *f = (cyg_uint32 *)xbuf; |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
727 |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
728 if (*len < sizeof(*f)) |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
729 return -EINVAL; |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
730 |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
731 cyg_drv_dsr_lock(); |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
732 switch (*f) { |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
733 case CYGNUM_SERIAL_FLOW_THROTTLE_RX: |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
734 throttle_rx( chan, true ); |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
735 break; |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
736 case CYGNUM_SERIAL_FLOW_RESTART_RX: |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
737 restart_rx( chan, true ); |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
738 break; |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
739 case CYGNUM_SERIAL_FLOW_THROTTLE_TX: |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
740 throttle_tx( chan ); |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
741 break; |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
742 case CYGNUM_SERIAL_FLOW_RESTART_TX: |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
743 restart_tx( chan ); |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
744 break; |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
745 default: |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
746 res = -EINVAL; |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
747 break; |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
748 } |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
749 cyg_drv_dsr_unlock(); |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
750 } |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
751 break; |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
752 #endif // CYGPKG_IO_SERIAL_FLOW_CONTROL |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
753 |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
754 #ifdef CYGOPT_IO_SERIAL_SUPPORT_LINE_STATUS |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
755 case CYG_IO_SET_CONFIG_SERIAL_STATUS_CALLBACK: |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
756 { |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
757 cyg_serial_line_status_callback_fn_t newfn; |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
758 CYG_ADDRWORD newpriv; |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
759 cyg_serial_line_status_callback_t *tmp = |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
760 (cyg_serial_line_status_callback_t *)xbuf; |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
761 |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
762 if ( *len < sizeof(*tmp) ) |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
763 return -EINVAL; |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
764 |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
765 newfn = tmp->fn; |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
766 newpriv = tmp->priv; |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
767 |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
768 // prevent callbacks while we do this |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
769 cyg_drv_dsr_lock(); |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
770 // store old callbacks in same structure |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
771 tmp->fn = chan->status_callback; |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
772 tmp->priv = chan->status_callback_priv; |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
773 chan->status_callback = newfn; |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
774 chan->status_callback_priv = newpriv; |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
775 cyg_drv_dsr_unlock(); |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
776 *len = sizeof(*tmp); |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
777 } |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
778 break; |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
779 #endif |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
780 |
| 2 | 781 default: |
|
115
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
782 // pass down to lower layers |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
783 return (funs->set_config)(chan, key, xbuf, len); |
| 2 | 784 } |
| 785 return res; | |
| 786 } | |
| 787 | |
|
115
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
788 // --------------------------------------------------------------------------- |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
789 |
| 2 | 790 static void |
| 791 serial_xmt_char(serial_channel *chan) | |
| 792 { | |
| 793 cbuf_t *cbuf = &chan->out_cbuf; | |
| 794 serial_funs *funs = chan->funs; | |
| 795 unsigned char c; | |
| 796 int space; | |
| 797 | |
|
115
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
798 #ifdef CYGOPT_IO_SERIAL_FLOW_CONTROL_SOFTWARE |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
799 // if we are required to send an XON/XOFF char, send it before anything else |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
800 // FIXME: what if XON gets corrupted in transit to the other end? |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
801 // Should we resend XON even though the other end may not be wanting |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
802 // to send us stuff at this point? |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
803 if ( chan->config.flags & CYGNUM_SERIAL_FLOW_XONXOFF_RX ) { |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
804 if ( chan->flow_desc.xchar ) { |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
805 if ( (funs->putc)(chan, chan->flow_desc.xchar) ) { |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
806 chan->flow_desc.xchar = '\0'; |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
807 } else { // otherwise there's no space and we have to wait |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
808 return; |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
809 } |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
810 } |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
811 } |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
812 #endif |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
813 #ifdef CYGPKG_IO_SERIAL_FLOW_CONTROL |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
814 // if we're meant to be throttled, just stop and leave |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
815 if ( chan->flow_desc.flags & CYG_SERIAL_FLOW_OUT_THROTTLED ) { |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
816 (funs->stop_xmit)(chan); // Stop transmitting for now |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
817 return; |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
818 } |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
819 #endif |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
820 while (cbuf->nb > 0) { |
| 2 | 821 c = cbuf->data[cbuf->get]; |
| 822 if ((funs->putc)(chan, c)) { | |
| 823 cbuf->get++; | |
| 824 if (cbuf->get == cbuf->len) cbuf->get = 0; | |
|
115
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
825 cbuf->nb--; |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
826 } else { |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
827 // See if there is now enough room to restart writer |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
828 space = cbuf->len - cbuf->nb; |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
829 if (space >= cbuf->low_water) { |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
830 if (cbuf->waiting) { |
| 2 | 831 cbuf->waiting = false; |
| 832 cyg_drv_cond_broadcast(&cbuf->wait); | |
| 833 } | |
|
115
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
834 #ifdef CYGPKG_IO_SERIAL_SELECT_SUPPORT |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
835 cyg_selwakeup( &cbuf->selinfo ); |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
836 #endif |
| 2 | 837 } |
| 838 return; // Need to wait for more space | |
| 839 } | |
| 840 } | |
| 841 (funs->stop_xmit)(chan); // Done with transmit | |
|
115
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
842 |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
843 // must signal waiters, and wake up selecters for the case when |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
844 // this was the last char to be sent and they hadn't been signalled |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
845 // before (e.g. because of flow control) |
| 2 | 846 if (cbuf->waiting) { |
| 847 cbuf->waiting = false; | |
| 848 cyg_drv_cond_signal(&cbuf->wait); | |
| 849 } | |
|
115
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
850 #ifdef CYGPKG_IO_SERIAL_SELECT_SUPPORT |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
851 cyg_selwakeup( &cbuf->selinfo ); |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
852 #endif |
| 2 | 853 } |
| 854 | |
|
115
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
855 // --------------------------------------------------------------------------- |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
856 |
| 2 | 857 static void |
| 858 serial_rcv_char(serial_channel *chan, unsigned char c) | |
| 859 { | |
| 860 cbuf_t *cbuf = &chan->in_cbuf; | |
| 861 | |
|
115
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
862 #ifdef CYGOPT_IO_SERIAL_FLOW_CONTROL_SOFTWARE |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
863 // for software flow control, if the driver returns one of the characters |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
864 // we act on it and then drop it (the app must not see it) |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
865 if ( chan->config.flags & CYGNUM_SERIAL_FLOW_XONXOFF_TX ) { |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
866 if ( c == CYGDAT_IO_SERIAL_FLOW_CONTROL_XOFF_CHAR ) { |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
867 throttle_tx( chan ); |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
868 return; // it wasn't a "real" character |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
869 } else if ( c == CYGDAT_IO_SERIAL_FLOW_CONTROL_XON_CHAR ) { |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
870 restart_tx( chan ); |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
871 return; // it wasn't a "real" character |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
872 } |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
873 } |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
874 #endif |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
875 #ifdef CYGPKG_IO_SERIAL_FLOW_CONTROL |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
876 // If we've hit the high water mark, tell the other side to stop |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
877 if ( cbuf->nb >= cbuf->high_water ) { |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
878 throttle_rx( chan, false ); |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
879 } |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
880 #endif |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
881 #ifdef CYGPKG_IO_SERIAL_SELECT_SUPPORT |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
882 // Wake up any pending selectors if we are about to |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
883 // put some data into a previously empty buffer. |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
884 if( cbuf->nb == 0 ) |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
885 cyg_selwakeup( &cbuf->selinfo ); |
|
86
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
886 #endif |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
887 |
|
115
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
888 // If the flow control is not enabled/sufficient and the buffer is |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
889 // already full, just throw new characters away. |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
890 |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
891 if( cbuf->nb < cbuf->len ) |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
892 { |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
893 cbuf->data[cbuf->put++] = c; |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
894 if (cbuf->put == cbuf->len) cbuf->put = 0; |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
895 cbuf->nb++; |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
896 } |
| 2 | 897 if (cbuf->waiting) { |
|
20
5f5102441818
Merge from eCos master repository on 1999-07-02-23:17:07-BST
jlarmour
parents:
4
diff
changeset
|
898 #ifdef XX_CYGDBG_DIAG_BUF |
|
5f5102441818
Merge from eCos master repository on 1999-07-02-23:17:07-BST
jlarmour
parents:
4
diff
changeset
|
899 extern int enable_diag_uart; |
|
5f5102441818
Merge from eCos master repository on 1999-07-02-23:17:07-BST
jlarmour
parents:
4
diff
changeset
|
900 int _enable = enable_diag_uart; |
|
5f5102441818
Merge from eCos master repository on 1999-07-02-23:17:07-BST
jlarmour
parents:
4
diff
changeset
|
901 int _time, _stime; |
|
5f5102441818
Merge from eCos master repository on 1999-07-02-23:17:07-BST
jlarmour
parents:
4
diff
changeset
|
902 externC cyg_tick_count_t cyg_current_time(void); |
|
5f5102441818
Merge from eCos master repository on 1999-07-02-23:17:07-BST
jlarmour
parents:
4
diff
changeset
|
903 enable_diag_uart = 0; |
|
5f5102441818
Merge from eCos master repository on 1999-07-02-23:17:07-BST
jlarmour
parents:
4
diff
changeset
|
904 HAL_CLOCK_READ(&_time); |
|
5f5102441818
Merge from eCos master repository on 1999-07-02-23:17:07-BST
jlarmour
parents:
4
diff
changeset
|
905 _stime = (int)cyg_current_time(); |
|
5f5102441818
Merge from eCos master repository on 1999-07-02-23:17:07-BST
jlarmour
parents:
4
diff
changeset
|
906 diag_printf("Signal reader - time: %x.%x\n", _stime, _time); |
|
5f5102441818
Merge from eCos master repository on 1999-07-02-23:17:07-BST
jlarmour
parents:
4
diff
changeset
|
907 enable_diag_uart = _enable; |
|
5f5102441818
Merge from eCos master repository on 1999-07-02-23:17:07-BST
jlarmour
parents:
4
diff
changeset
|
908 #endif // CYGDBG_DIAG_BUF |
| 2 | 909 cbuf->waiting = false; |
| 910 cyg_drv_cond_signal(&cbuf->wait); | |
| 911 } | |
| 912 } | |
| 913 | |
|
86
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
914 //---------------------------------------------------------------------------- |
|
115
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
915 // Flow control indication callback |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
916 |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
917 #ifdef CYGOPT_IO_SERIAL_SUPPORT_LINE_STATUS |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
918 static void |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
919 serial_indicate_status(serial_channel *chan, cyg_serial_line_status_t *s ) |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
920 { |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
921 #ifdef CYGPKG_IO_SERIAL_FLOW_CONTROL |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
922 if ( CYGNUM_SERIAL_STATUS_FLOW == s->which ) { |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
923 if ( s->value ) |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
924 restart_tx( chan ); |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
925 else |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
926 throttle_tx( chan ); |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
927 } |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
928 #endif |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
929 if ( chan->status_callback ) |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
930 (*chan->status_callback)(s, chan->status_callback_priv); |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
931 } |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
932 #endif // ifdef CYGOPT_IO_SERIAL_SUPPORT_LINE_STATUS |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
933 |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
934 //---------------------------------------------------------------------------- |
|
86
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
935 // Block transfer functions. Not all drivers require these. |
|
115
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
936 #if CYGINT_IO_SERIAL_BLOCK_TRANSFER |
|
86
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
937 |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
938 static bool |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
939 serial_data_rcv_req(serial_channel *chan, int avail, |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
940 int* space_avail, unsigned char** space) |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
941 { |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
942 cbuf_t *cbuf = &chan->in_cbuf; |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
943 int gap; |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
944 |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
945 // Check for space |
|
115
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
946 gap = cbuf->nb; |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
947 if (gap == cbuf->len) |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
948 return false; // full |
|
86
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
949 |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
950 if (0 == gap) { |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
951 // Buffer is empty. Reset put/get indexes to get max transfer in |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
952 // one chunk. |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
953 cbuf->get = 0; |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
954 cbuf->put = 0; |
|
115
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
955 gap = cbuf->len; |
|
86
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
956 } else { |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
957 // Free space (G = get, P = put, x = data, . = empty) |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
958 // positive: xxxxP.....Gxxx |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
959 // negative: ..GxxxxxP..... [offer last chunk only] |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
960 |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
961 // First try for a gap between put and get locations |
|
115
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
962 gap = cbuf->get - cbuf->put; |
|
86
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
963 if (gap < 0) { |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
964 // If failed, the gap is between put and the end of buffer |
|
107
7f461c3a372c
Merge from eCos master repository on 2000-07-04-08:04:30-BST
jlarmour
parents:
88
diff
changeset
|
965 gap = cbuf->len - cbuf->put; |
|
86
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
966 } |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
967 } |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
968 |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
969 if (avail < gap) gap = avail; // bound by what's available from hw |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
970 |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
971 *space_avail = gap; |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
972 *space = &cbuf->data[cbuf->put]; |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
973 cbuf->put += gap; |
|
115
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
974 cbuf->nb += gap; |
|
86
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
975 |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
976 if (cbuf->put == cbuf->len) cbuf->put = 0; |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
977 |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
978 return true; |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
979 } |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
980 |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
981 static void |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
982 serial_data_rcv_done(serial_channel *chan) |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
983 { |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
984 cbuf_t *cbuf = &chan->in_cbuf; |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
985 if (cbuf->waiting) { |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
986 cbuf->waiting = false; |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
987 cyg_drv_cond_signal(&cbuf->wait); |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
988 } |
|
115
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
989 #ifdef CYGPKG_IO_SERIAL_SELECT_SUPPORT |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
990 // Wake up any pending selectors if we have |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
991 // put some data into a previously empty buffer. |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
992 cyg_selwakeup( &cbuf->selinfo ); |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
993 #endif |
|
86
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
994 } |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
995 |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
996 static bool |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
997 serial_data_xmt_req(serial_channel *chan, int space, |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
998 int* chars_avail, unsigned char** chars) |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
999 { |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
1000 cbuf_t *cbuf = &chan->out_cbuf; |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
1001 int avail; |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
1002 |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
1003 // Available data (G = get, P = put, x = data, . = empty) |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
1004 // 0: no data |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
1005 // negative: xxxxP.....Gxxx [offer last chunk only] |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
1006 // positive: ..GxxxxxP..... |
|
115
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
1007 if (0 == cbuf->nb) |
|
86
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
1008 return false; |
|
115
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
1009 if (cbuf->get >= cbuf->put) { |
|
86
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
1010 avail = cbuf->len - cbuf->get; |
|
115
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
1011 } else { |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
1012 avail = cbuf->put - cbuf->get; |
|
86
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
1013 } |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
1014 |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
1015 if (avail > space) avail = space; // bound by space in hardware |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
1016 |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
1017 *chars_avail = avail; |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
1018 *chars = &cbuf->data[cbuf->get]; |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
1019 cbuf->get += avail; |
|
115
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
1020 cbuf->nb -= avail; |
|
86
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
1021 |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
1022 if (cbuf->get == cbuf->len) cbuf->get = 0; |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
1023 |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
1024 return true; |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
1025 } |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
1026 |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
1027 static void |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
1028 serial_data_xmt_done(serial_channel *chan) |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
1029 { |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
1030 cbuf_t *cbuf = &chan->out_cbuf; |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
1031 serial_funs *funs = chan->funs; |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
1032 int space; |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
1033 |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
1034 (funs->stop_xmit)(chan); // Done with transmit |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
1035 |
|
115
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
1036 // See if there is now enough room to restart writer |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
1037 space = cbuf->len - cbuf->nb; |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
1038 if (space >= cbuf->low_water) { |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
1039 if (cbuf->waiting) { |
|
86
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
1040 cbuf->waiting = false; |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
1041 cyg_drv_cond_broadcast(&cbuf->wait); |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
1042 } |
|
115
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
1043 #ifdef CYGPKG_IO_SERIAL_SELECT_SUPPORT |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
1044 cyg_selwakeup( &cbuf->selinfo ); |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
1045 #endif |
|
86
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
1046 } |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
1047 } |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
1048 |
|
6512add4f5d6
Merge from eCos master repository on 2000-05-05-07:47:05-BST
jlarmour
parents:
82
diff
changeset
|
1049 #endif // CYGINT_IO_SERIAL_BLOCK_TRANSFER |
|
115
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
1050 |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
1051 // --------------------------------------------------------------------------- |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
1052 |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
107
diff
changeset
|
1053 // EOF serial.c |
