Mercurial > ecos
annotate packages/io/serial/current/tests/ser_test_protocol.inl @ 6:d376b777e2ce ecos-sw-1999-05-14
Merge from eCos master repository on 1999-05-14-19:27:43-BST
| author | jlarmour |
|---|---|
| date | Fri, 14 May 1999 12:20:00 +0000 |
| parents | 1d7f19c9e4d1 |
| children | d3fbcdfa1b2f |
| rev | line source |
|---|---|
| 2 | 1 //========================================================================== |
| 2 // | |
| 3 // ser_test_protocol.c | |
| 4 // | |
| 5 // Serial device driver testing protocol | |
| 6 // | |
| 7 //========================================================================== | |
| 8 //####COPYRIGHTBEGIN#### | |
| 9 // | |
| 10 // ------------------------------------------- | |
| 11 // The contents of this file are subject to the Cygnus eCos Public License | |
| 12 // Version 1.0 (the "License"); you may not use this file except in | |
| 13 // compliance with the License. You may obtain a copy of the License at | |
| 14 // http://sourceware.cygnus.com/ecos | |
| 15 // | |
| 16 // Software distributed under the License is distributed on an "AS IS" | |
| 17 // basis, WITHOUT WARRANTY OF ANY KIND, either express or implied. See the | |
| 18 // License for the specific language governing rights and limitations under | |
| 19 // the License. | |
| 20 // | |
| 21 // The Original Code is eCos - Embedded Cygnus Operating System, released | |
| 22 // September 30, 1998. | |
| 23 // | |
| 24 // The Initial Developer of the Original Code is Cygnus. Portions created | |
| 25 // by Cygnus are Copyright (C) 1998, 1999 Cygnus Solutions. | |
| 26 // All Rights Reserved. | |
| 27 // ------------------------------------------- | |
| 28 // | |
| 29 //####COPYRIGHTEND#### | |
| 30 //========================================================================== | |
| 31 //#####DESCRIPTIONBEGIN#### | |
| 32 // | |
| 33 // Author(s): jskov | |
| 34 // Contributors: jskov | |
| 35 // Date: 1999-03-17 | |
| 36 // Description: Protocol implementation used to test eCos serial devices. | |
| 37 // Relies on ser_filter to be present on the host side to | |
| 38 // respond to test requests. | |
| 39 // | |
| 40 // To Do: | |
| 41 // o Clean up. | |
| 42 // o Clean up config change magic. | |
| 43 // o Figure out how to handle kernel dependency | |
| 44 // : without kernel, no timeout. Without timeout, no filter auto detection. | |
| 45 // | |
| 46 //####DESCRIPTIONEND#### | |
| 47 | |
| 48 #include <pkgconf/system.h> | |
| 49 #include <pkgconf/io.h> | |
| 50 #include <pkgconf/io_serial.h> | |
| 51 | |
| 52 #include <cyg/io/io.h> | |
| 53 #include <cyg/io/devtab.h> | |
| 54 #include <cyg/io/ttyio.h> | |
| 55 #include <cyg/infra/diag.h> | |
| 56 | |
| 57 #include <cyg/hal/hal_intr.h> // for reclaiming interrup vector | |
| 58 | |
|
4
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
59 #ifdef CYG_HAL_SPARCLITE_SLEB |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
60 #include <pkgconf/hal_sparclite_sleb.h> // CYG_KERNEL_DIAG_GDB_SERIAL_DIRECT |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
61 #endif |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
62 |
| 2 | 63 //---------------------------------------------------------------------------- |
| 64 // Definition of which device to run tests on on various platforms. | |
|
4
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
65 |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
66 #define NA_MSG "No test device specified" |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
67 |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
68 |
| 2 | 69 #if defined(CYGPKG_HAL_POWERPC_COGENT) \ |
| 70 && defined(CYGPKG_IO_SERIAL_POWERPC_COGENT) \ | |
| 71 && defined(CYGPKG_IO_SERIAL_POWERPC_COGENT_SERIAL_B) | |
| 72 # define TEST_SER_DEV CYGDAT_IO_SERIAL_POWERPC_COGENT_SERIAL_B_NAME | |
| 73 # if defined(CYGPKG_IO_SERIAL_TTY_TTY2) | |
| 74 # define TEST_TTY_DEV CYGDAT_IO_SERIAL_TTY_TTY2_DEV | |
| 75 # endif | |
| 76 #endif | |
| 77 #if defined(CYGPKG_HAL_ARM_PID) \ | |
| 78 && defined(CYGPKG_IO_SERIAL_ARM_PID) \ | |
| 79 && defined(CYGPKG_IO_SERIAL_ARM_PID_SERIAL0) | |
| 80 # define TEST_SER_DEV CYGDAT_IO_SERIAL_ARM_PID_SERIAL0_NAME | |
| 81 # if defined(CYGPKG_IO_SERIAL_TTY_TTY0) | |
| 82 # define TEST_TTY_DEV CYGDAT_IO_SERIAL_TTY_TTY0_DEV | |
| 83 # endif | |
| 84 #endif | |
| 85 #if defined(CYGPKG_HAL_ARM_AEB) \ | |
| 86 && defined(CYGPKG_IO_SERIAL_ARM_AEB) \ | |
| 87 && defined(CYGPKG_IO_SERIAL_ARM_AEB_SERIAL1) | |
| 88 # define TEST_SER_DEV CYGDAT_IO_SERIAL_ARM_AEB_SERIAL1_NAME | |
| 89 # if defined(CYGPKG_IO_SERIAL_TTY_TTY1) | |
| 90 # define TEST_TTY_DEV CYGDAT_IO_SERIAL_TTY_TTY1_DEV | |
| 91 # endif | |
| 92 #endif | |
| 93 #if defined(CYGPKG_HAL_TX39_JMR3904) \ | |
| 94 && defined(CYGPKG_IO_SERIAL_TX39_JMR3904) \ | |
| 95 && defined(CYGPKG_IO_SERIAL_TX39_JMR3904_SERIAL0) | |
| 96 # define TEST_SER_DEV CYGDAT_IO_SERIAL_TX39_JMR3904_SERIAL0_NAME | |
| 97 # if defined(CYGPKG_IO_SERIAL_TTY_TTY1) | |
| 98 # define TEST_TTY_DEV CYGDAT_IO_SERIAL_TTY_TTY1_DEV | |
| 99 # endif | |
| 100 #endif | |
| 101 #if defined(CYGPKG_HAL_MN10300_STDEVAL1) \ | |
| 102 && defined(CYGPKG_IO_SERIAL_MN10300) \ | |
|
4
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
103 && defined(CYGPKG_IO_SERIAL_MN10300_SERIAL2) |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
104 # define TEST_SER_DEV CYGDAT_IO_SERIAL_MN10300_SERIAL2_NAME |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
105 # if defined(CYGPKG_IO_SERIAL_TTY_TTY2) |
| 2 | 106 # define TEST_TTY_DEV CYGDAT_IO_SERIAL_TTY_TTY1_DEV |
| 107 # endif | |
| 108 #endif | |
| 109 #if defined(CYGPKG_HAL_SPARCLITE_SLEB) \ | |
| 110 && defined(CYGPKG_IO_SERIAL_SPARCLITE_SLEB) \ | |
| 111 && defined(CYGPKG_IO_SERIAL_SPARCLITE_SLEB_CON1) | |
|
4
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
112 # undef NA_MSG |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
113 # define NA_MSG "CYG_KERNEL_DIAG_GDB_SERIAL_DIRECT is unset" |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
114 # if !defined(CYG_HAL_STARTUP_RAM) \ |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
115 || defined(CYG_KERNEL_DIAG_GDB_SERIAL_DIRECT) |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
116 # define TEST_SER_DEV CYGDAT_IO_SERIAL_SPARCLITE_SLEB_CON1_NAME |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
117 // The interrupt vectors are normally in CygMon's control. Steal them back, |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
118 // but beware that this results in GDB acknowledge characters showing up in |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
119 // the serial driver if CygMon is used for hal_diag output. |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
120 // Set CYG_KERNEL_DIAG_GDB_SERIAL_DIRECT in hal_sparclite_sleb as a workaround. |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
121 # define SER_OVERRIDE_INT_1 CYGNUM_HAL_INTERRUPT_9 |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
122 # define SER_OVERRIDE_INT_2 CYGNUM_HAL_INTERRUPT_10 |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
123 # if defined(CYGPKG_IO_SERIAL_TTY_TTY0) |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
124 # define TEST_TTY_DEV CYGDAT_IO_SERIAL_TTY_TTY0_DEV |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
125 # endif |
| 2 | 126 # endif |
| 127 #endif | |
| 128 | |
| 129 | |
| 130 // We can't rely on haldiag for ser_filter detection - it may not define | |
| 131 // a working character reading function. | |
| 132 #ifndef TEST_SER_DEV | |
| 133 # define SER_NOP_TEST | |
| 134 # define TTY_NOP_TEST | |
| 135 # define TEST_SER_DEV "/dev/null" | |
| 136 # define TEST_TTY_DEV "/dev/null" | |
| 137 #else | |
| 138 # ifndef TEST_TTY_DEV | |
| 139 # define TTY_NOP_TEST | |
| 140 # define TEST_TTY_DEV "/dev/null" | |
| 141 # endif | |
| 142 #endif | |
| 143 | |
| 144 //---------------------------------------------------------------------------- | |
| 145 // The data in buffer and the cmd buffer | |
| 146 #define IN_BUFFER_SIZE 1024 | |
| 147 cyg_uint8 in_buffer[IN_BUFFER_SIZE]; | |
| 148 | |
| 149 cyg_int8 cmd_buffer[128]; | |
| 150 | |
| 151 //---------------------------------------------------------------------------- | |
| 152 // Some types specific to the testing protocol. | |
| 153 typedef enum { | |
| 154 MODE_NO_ECHO = 0, | |
| 155 MODE_EOP_ECHO, | |
| 156 MODE_DUPLEX_ECHO | |
| 157 } cyg_mode_t; | |
| 158 | |
| 159 typedef enum { | |
| 160 TEST_RETURN_OK = ENOERR, | |
| 161 TEST_RETURN_NA | |
| 162 } cyg_test_return_t; | |
| 163 | |
| 164 typedef struct ser_cfg { | |
| 165 cyg_serial_baud_rate_t baud_rate; | |
| 166 cyg_serial_word_length_t data_bits; | |
| 167 cyg_serial_stop_bits_t stop_bits; | |
| 168 cyg_serial_parity_t parity; | |
| 169 // etc... | |
| 170 } cyg_ser_cfg_t; | |
| 171 | |
| 172 //---------------------------------------------------------------------------- | |
| 173 // A few predefined configurations. These must all be valid for any | |
| 174 // given target until change_config is behaving correctly. | |
| 175 cyg_ser_cfg_t test_configs[] = { | |
|
4
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
176 |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
177 #if !defined(CYGPKG_HAL_TX39_JMR3904) && !defined(CYGPKG_HAL_ARM_PID) |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
178 { CYGNUM_SERIAL_BAUD_9600, CYGNUM_SERIAL_WORD_LENGTH_8, |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
179 CYGNUM_SERIAL_STOP_1, CYGNUM_SERIAL_PARITY_NONE }, |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
180 #endif |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
181 |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
182 { CYGNUM_SERIAL_BAUD_14400, CYGNUM_SERIAL_WORD_LENGTH_8, |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
183 CYGNUM_SERIAL_STOP_1, CYGNUM_SERIAL_PARITY_NONE }, |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
184 |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
185 { CYGNUM_SERIAL_BAUD_19200, CYGNUM_SERIAL_WORD_LENGTH_8, |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
186 CYGNUM_SERIAL_STOP_1, CYGNUM_SERIAL_PARITY_NONE }, |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
187 |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
188 #if !defined(CYGPKG_HAL_SPARCLITE_SLEB) && \ |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
189 !defined(CYGPKG_HAL_ARM_AEB) |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
190 { CYGNUM_SERIAL_BAUD_38400, CYGNUM_SERIAL_WORD_LENGTH_8, |
| 2 | 191 CYGNUM_SERIAL_STOP_1, CYGNUM_SERIAL_PARITY_NONE }, |
| 192 #endif | |
| 193 | |
| 194 #if !defined(CYGPKG_HAL_TX39_JMR3904) && \ | |
| 195 !defined(CYGPKG_HAL_ARM_AEB) && \ | |
| 196 !defined(CYGPKG_HAL_SPARCLITE_SLEB) | |
| 197 { CYGNUM_SERIAL_BAUD_57600, CYGNUM_SERIAL_WORD_LENGTH_8, | |
| 198 CYGNUM_SERIAL_STOP_1, CYGNUM_SERIAL_PARITY_NONE }, | |
| 199 #endif | |
| 200 | |
|
4
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
201 #if !defined(CYGPKG_HAL_TX39_JMR3904) && \ |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
202 !defined(CYGPKG_HAL_ARM_PID) && \ |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
203 !defined(CYGPKG_HAL_ARM_AEB) && \ |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
204 !defined(CYGPKG_HAL_MN10300_STDEVAL1) && \ |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
205 !defined(CYGPKG_HAL_SPARCLITE_SLEB) |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
206 { CYGNUM_SERIAL_BAUD_115200, CYGNUM_SERIAL_WORD_LENGTH_8, |
| 2 | 207 CYGNUM_SERIAL_STOP_1, CYGNUM_SERIAL_PARITY_NONE }, |
| 208 #endif | |
| 209 | |
| 210 #if !defined(CYGPKG_HAL_TX39_JMR3904) && \ | |
| 211 !defined(CYGPKG_HAL_ARM_AEB) && \ | |
| 212 !defined(CYGPKG_HAL_ARM_PID) | |
| 213 // One stop bit, even parity | |
| 214 { CYGNUM_SERIAL_BAUD_19200, CYGNUM_SERIAL_WORD_LENGTH_8, | |
| 215 CYGNUM_SERIAL_STOP_1, CYGNUM_SERIAL_PARITY_EVEN }, | |
| 216 #endif | |
| 217 | |
| 218 #if !defined(CYGPKG_HAL_TX39_JMR3904) && \ | |
| 219 !defined(CYGPKG_HAL_ARM_AEB) && \ | |
| 220 !defined(CYGPKG_HAL_ARM_PID) | |
| 221 // Two stop bits, even parity | |
| 222 { CYGNUM_SERIAL_BAUD_19200, CYGNUM_SERIAL_WORD_LENGTH_8, | |
| 223 CYGNUM_SERIAL_STOP_2, CYGNUM_SERIAL_PARITY_EVEN }, | |
| 224 #endif | |
| 225 | |
| 226 #if !defined(CYGPKG_HAL_TX39_JMR3904) | |
| 227 // Two stop bits, no parity | |
| 228 { CYGNUM_SERIAL_BAUD_19200, CYGNUM_SERIAL_WORD_LENGTH_8, | |
| 229 CYGNUM_SERIAL_STOP_2, CYGNUM_SERIAL_PARITY_NONE }, | |
| 230 #endif | |
| 231 }; | |
| 232 | |
| 233 //---------------------------------------------------------------------------- | |
| 234 // Macros to help extract values from the argument string. | |
| 235 // Note: This is probably not an ideal solution, but it was easy to make :) | |
| 236 | |
| 237 #define INIT_VALUE(__args) \ | |
| 238 unsigned int v; \ | |
| 239 char *__ptr1, *__ptr2 = (__args) | |
| 240 | |
| 241 #define SET_VALUE(__slot) \ | |
| 242 do { \ | |
| 243 __ptr1 = index(__ptr2, (int) ':'); \ | |
| 244 if (__ptr1) \ | |
| 245 *__ptr1 = 0; \ | |
| 246 v = atoi(__ptr2); \ | |
| 247 __ptr2 = __ptr1+1; \ | |
| 248 (__slot) = v; \ | |
| 249 } while (0) | |
| 250 | |
| 251 | |
| 252 //---------------------------------------------------------------------------- | |
| 253 // CRC magic - it's a bit of a hack for now. | |
| 254 // FIXME: standard definition? | |
| 255 #define ADD_CRC_BYTE(__crc, __c) \ | |
| 256 CYG_MACRO_START \ | |
| 257 (__crc) = ((__crc) << 1) ^ (__c); \ | |
| 258 CYG_MACRO_END | |
| 259 | |
| 260 // FIXME: Hack to allow easy ASCII transfer. | |
| 261 #define FIX_CRC(__crc, __icrc) \ | |
| 262 CYG_MACRO_START \ | |
| 263 __icrc = (int) (__crc); \ | |
| 264 if (__icrc < 0) \ | |
| 265 __icrc = -__icrc; \ | |
| 266 CYG_MACRO_END | |
| 267 | |
| 268 //---------------------------------------------------------------------------- | |
| 269 // Macros for read/write to serial with error cheking. | |
|
4
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
270 static volatile cyg_uint32 r_stamp; |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
271 static volatile int aborted; |
| 2 | 272 |
| 273 // This routine will be called if the read "times out" | |
| 274 static void | |
| 275 do_abort(void *handle) | |
| 276 { | |
| 277 cyg_io_handle_t io_handle = (cyg_io_handle_t)handle; | |
| 278 cyg_int32 len = 1; // Need something here | |
| 279 cyg_io_get_config(io_handle, CYG_IO_GET_CONFIG_SERIAL_ABORT, 0, &len); | |
|
4
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
280 aborted = 1; |
| 2 | 281 } |
| 282 #include "timeout.inl" | |
| 283 | |
| 284 // Read with timeout (__t = timeout in ticks, int* __r = result) | |
| 285 #define Tcyg_io_read_timeout(__h, __d, __l, __t, __r) \ | |
| 286 CYG_MACRO_START \ | |
| 287 int __res; \ | |
| 288 r_stamp = timeout((__t), do_abort, (__h)); \ | |
| 289 __res = cyg_io_read((__h), (__d), (__l)); \ | |
| 290 CYG_TEST_CHECK((ENOERR == __res || -EINTR == __res),"cyg_io_read failed");\ | |
| 291 *(__r) = __res; \ | |
| 292 untimeout(r_stamp); \ | |
| 293 CYG_MACRO_END | |
| 294 | |
| 295 #define Tcyg_io_read(__h, __d, __l) \ | |
| 296 CYG_MACRO_START \ | |
| 297 int __res = cyg_io_read((__h), (__d), (__l)); \ | |
| 298 CYG_TEST_CHECK(ENOERR == __res, "cyg_io_read failed"); \ | |
| 299 CYG_MACRO_END | |
| 300 | |
| 301 #define Tcyg_io_write(__h, __d, __l) \ | |
| 302 CYG_MACRO_START \ | |
| 303 int __res; \ | |
| 304 cyg_uint32 __len = 1; \ | |
| 305 __res = cyg_io_write((__h), (__d), (__l)); \ | |
|
4
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
306 if (ENOERR != __res) diag_printf("[%d]\n", __res); \ |
| 2 | 307 CYG_TEST_CHECK(ENOERR == __res, "cyg_io_write failed"); \ |
| 308 __res = cyg_io_get_config((__h), \ | |
| 309 CYG_IO_GET_CONFIG_SERIAL_OUTPUT_DRAIN, \ | |
| 310 0, &__len); \ | |
| 311 CYG_TEST_CHECK(ENOERR == __res, "DRAIN failed"); \ | |
| 312 CYG_MACRO_END | |
| 313 | |
| 314 | |
| 315 //---------------------------------------------------------------------------- | |
| 316 // Some libc like functions that are handy to have around. | |
| 317 static int | |
| 318 strlen(const char *c) | |
| 319 { | |
| 320 int l = 0; | |
| 321 while (*c++) l++; | |
| 322 return l; | |
| 323 } | |
| 324 | |
| 325 static char* | |
| 326 strcpy(char* dest, const char* src) | |
| 327 { | |
| 328 char c; | |
| 329 while ((c = *src++)) { | |
| 330 *dest++ = c; | |
| 331 } | |
| 332 *dest = c; | |
| 333 | |
| 334 return dest; | |
| 335 } | |
| 336 | |
| 337 static char* | |
| 338 itoa(char* dest, int v) | |
| 339 { | |
| 340 char b[16]; | |
| 341 char* p = &b[16]; | |
| 342 | |
| 343 *--p = 0; | |
| 344 if (v) { | |
| 345 while (v){ | |
| 346 *--p = (v % 10) + '0'; | |
| 347 v = v / 10; | |
| 348 } | |
| 349 } else | |
| 350 *--p = '0'; | |
| 351 | |
| 352 return strcpy(dest, p); | |
| 353 } | |
| 354 | |
| 355 #define min(_a, _b) ((_a) < (_b)) ? (_a) : (_b) | |
| 356 | |
| 357 void | |
| 358 hang(void) | |
| 359 { | |
| 360 while (1); | |
| 361 } | |
| 362 | |
| 363 //----------------------------------------------------------------------------- | |
| 364 // Configuration changing function. | |
|
4
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
365 // |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
366 // First change to the new config and back again to determine if the driver |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
367 // can handle the config. |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
368 // If not, return error. |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
369 // |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
370 // Then query the host for its capability to use the config: |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
371 // Format out: |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
372 // "@CONFIG:<baud rate code>:<#data bits>:<#stop bits>:<parity on/off>!" |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
373 // Format in: |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
374 // OK/ER |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
375 // |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
376 // On ER, return error. |
| 2 | 377 // |
|
4
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
378 // On OK, change to the new configuration. Resynchronize with the host: |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
379 // Write 'T'-chars to the host. |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
380 // The host will echo anything it reads until it sees a 'O' character. |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
381 // Continue until four 'T'-chars has been read back. |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
382 // Then send a single 'O'-character. This will signal success to the host. |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
383 // |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
384 // If the synchronization has not succeeded within 100 ticks |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
385 // (configurable in the protocol), both host and target will revert to |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
386 // the previous configuration and attempt to synchronize again. If |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
387 // this fails, this call will hang and the host will consider the test |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
388 // a failure. |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
389 // |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
390 // To Do: |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
391 // Host&protocol currently only supports: |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
392 // - no/even parity |
| 2 | 393 int |
| 394 change_config(cyg_io_handle_t handle, cyg_ser_cfg_t* cfg) | |
| 395 { | |
|
4
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
396 cyg_serial_info_t old_cfg, new_cfg; |
| 2 | 397 const char cmd[] = "@CONFIG:"; |
| 398 char reply[2]; | |
| 399 int msglen; | |
|
4
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
400 int res, len; |
| 2 | 401 cyg_uint8 *p1; |
|
4
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
402 |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
403 // Prepare the command. |
| 2 | 404 p1 = &cmd_buffer[0]; |
| 405 p1 = strcpy(p1, &cmd[0]); | |
| 406 p1 = itoa(p1, cfg->baud_rate); | |
| 407 *p1++ = ':'; | |
| 408 p1 = itoa(p1, cfg->data_bits); | |
| 409 *p1++ = ':'; | |
| 410 p1 = itoa(p1, cfg->stop_bits); | |
| 411 *p1++ = ':'; | |
| 412 p1 = itoa(p1, cfg->parity); | |
| 413 *p1++ = '!'; | |
|
4
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
414 *p1 = 0; // note: we may append to this later |
| 2 | 415 |
|
4
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
416 // Tell user what we're up to. |
| 2 | 417 CYG_TEST_INFO(&cmd_buffer[1]); |
| 418 | |
|
4
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
419 // Change to new config and then back to determine if the driver likes it. |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
420 len = sizeof(old_cfg); |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
421 res = cyg_io_get_config(handle, CYG_IO_GET_CONFIG_SERIAL_INFO, |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
422 &old_cfg, &len); |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
423 res = cyg_io_get_config(handle, CYG_IO_GET_CONFIG_SERIAL_INFO, |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
424 &new_cfg, &len); |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
425 if (res != ENOERR) { |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
426 diag_printf("Can't get serial config - DEVIO error: %d\n", res); |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
427 hang(); |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
428 } |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
429 |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
430 new_cfg.baud = cfg->baud_rate; |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
431 new_cfg.word_length = cfg->data_bits; |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
432 new_cfg.stop = cfg->stop_bits; |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
433 new_cfg.parity = cfg->parity; |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
434 |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
435 res = cyg_io_set_config(handle, CYG_IO_SET_CONFIG_SERIAL_INFO, |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
436 &new_cfg, &len); |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
437 |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
438 // Driver didn't like it. It will not have changed anything, so it's |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
439 // safe to return now. |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
440 if (ENOERR != res) { |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
441 // Let user know that the config was skipped due to the target. |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
442 const char txt_tskipped[] = "- skipped by target!"; |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
443 p1 = strcpy(p1, txt_tskipped); |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
444 *p1 = 0; |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
445 CYG_TEST_INFO(&cmd_buffer[1]); |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
446 return res; |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
447 } |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
448 |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
449 // Succeeded. Change back to the original config so we can communicate |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
450 // with the host. |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
451 res = cyg_io_set_config(handle, CYG_IO_SET_CONFIG_SERIAL_INFO, |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
452 &old_cfg, &len); |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
453 if (ENOERR != res) { |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
454 diag_printf("change_config: set_config failed/1 (%d)\n", res); |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
455 hang(); |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
456 } |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
457 |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
458 // Send command to host and read host's reply. |
| 2 | 459 msglen = strlen(&cmd_buffer[0]); |
| 460 Tcyg_io_write(handle, &cmd_buffer[0], &msglen); | |
| 461 msglen = 2; | |
| 462 Tcyg_io_read(handle, &reply[0], &msglen); | |
| 463 | |
|
4
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
464 // Did host accept configuration? |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
465 if ('O' != reply[0] || 'K' != reply[1]) { |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
466 // Let user know that the config was skipped due to the host. |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
467 const char txt_hskipped[] = "- skipped by host!"; |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
468 p1 = strcpy(p1, txt_hskipped); |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
469 *p1 = 0; |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
470 CYG_TEST_INFO(&cmd_buffer[1]); |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
471 diag_printf("Host didn't accept config (%02x, %02x).\n", |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
472 reply[0], reply[1]); |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
473 |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
474 res = ENOSUPP; |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
475 return res; |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
476 } |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
477 |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
478 // Now test the new configuration: Loop until we read what we |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
479 // write. This may hang (as seen from the host), but only when we |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
480 // get totally lost, in which case there's not much else to do |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
481 // really. In this case the host will consider the test a FAIL. |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
482 len = sizeof(new_cfg); |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
483 res = cyg_io_set_config(handle, CYG_IO_SET_CONFIG_SERIAL_INFO, |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
484 &new_cfg, &len); |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
485 if (ENOERR != res) { |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
486 diag_printf("change_config: set_config failed/2 (%d)\n", res); |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
487 hang(); |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
488 } |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
489 |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
490 // Note: Only sends a single char - a string wuld be safer, but if |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
491 // there's not a 1-1 relationship between outgoing and incoming |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
492 // chars, the reader needs to be smarter. Compensate by |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
493 // requirering the char to be read 4 times in succession. |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
494 for (;;) { |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
495 int change_succeeded = 0; |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
496 int using_old_config = 0; |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
497 int matches = 0; |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
498 char in_buf[1]; |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
499 int len; |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
500 char out_buf[1]; |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
501 |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
502 out_buf[0] = 'a'; |
| 2 | 503 |
|
4
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
504 aborted = 0; // global abort flag |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
505 // FIXME: Timeout time needs to be configurable, and needs to |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
506 // be sent to the host before getting here. That would allow |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
507 // changing the timeout by just rebuilding the test - without |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
508 // changing the host software. |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
509 r_stamp = timeout(100, do_abort, handle); |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
510 while (!aborted) { |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
511 len = 1; |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
512 res = cyg_io_write(handle, out_buf, &len); |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
513 if (ENOERR != res && -EINTR != res) { |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
514 // We may have to reset the driver here if the fail |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
515 // was due to a framing or parity error. |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
516 break; |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
517 } |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
518 |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
519 len = 1; |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
520 res = cyg_io_read(handle, in_buf, &len); |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
521 if (ENOERR != res && -EINTR != res) { |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
522 // We may have to reset the driver here if the fail |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
523 // was due to a framing or parity error. |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
524 break; |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
525 } |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
526 |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
527 // Check for match. |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
528 if (out_buf[0] == in_buf[0]) { |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
529 matches++; |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
530 // We want 4 in succession before we accept it. |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
531 if (4 == matches) { |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
532 change_succeeded = 1; |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
533 break; |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
534 } |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
535 } else |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
536 matches = 0; |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
537 } |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
538 untimeout(r_stamp); |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
539 |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
540 // Did we succeed? |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
541 if (change_succeeded) { |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
542 // Yup! Send 'O' to host so it knows we're OK. |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
543 const char ok_str[1] = "O"; |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
544 len = 1; |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
545 res = cyg_io_write(handle, ok_str, &len); |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
546 if (res != ENOERR) { |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
547 diag_printf("write failed - DEVIO error: %d\n", res); |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
548 hang(); |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
549 } |
| 2 | 550 |
|
4
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
551 // Now wait for the 'O' to be echoed so we know both lines |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
552 // have been emptied. |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
553 r_stamp = timeout(100, do_abort, handle); |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
554 do { |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
555 len = 1; |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
556 res = cyg_io_read(handle, in_buf, &len); |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
557 CYG_ASSERT(ENOERR == res, "Failed when waiting for 'O'"); |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
558 } while ('O' != in_buf[0]); |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
559 untimeout(r_stamp); |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
560 |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
561 // If we had to revert to the old configuration, return error. |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
562 if (using_old_config) |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
563 return -EIO; |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
564 else |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
565 return ENOERR; |
| 2 | 566 } |
| 567 | |
|
4
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
568 // We didn't. Due to an IO error? |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
569 if (ENOERR != res && -EINTR != res) { |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
570 // We may have to reset the driver if the fail was due to |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
571 // a framing or parity error. |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
572 } |
| 2 | 573 |
|
4
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
574 // Revert to the old configuration and try again. |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
575 len = sizeof(old_cfg); |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
576 res = cyg_io_set_config(handle, CYG_IO_SET_CONFIG_SERIAL_INFO, |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
577 &old_cfg, &len); |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
578 if (res != ENOERR) { |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
579 diag_printf("change_config: set_config failed/3 (%d)\n", res); |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
580 hang(); |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
581 } |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
582 out_buf[0] = 't'; // change the char so a developer can |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
583 // see this has happened by the chars |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
584 // being written. |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
585 using_old_config = 1; |
|
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
586 } |
| 2 | 587 } |
| 588 | |
| 589 | |
| 590 //----------------------------------------------------------------------------- | |
| 591 // Host sends CRC in decimal ASCII, terminated with ! | |
| 592 int | |
| 593 read_host_crc(cyg_io_handle_t handle) | |
| 594 { | |
| 595 int crc, len; | |
| 596 cyg_uint8 ch; | |
| 597 | |
| 598 crc = 0; | |
| 599 while (1) { | |
| 600 len = 1; | |
| 601 Tcyg_io_read(handle, &ch, &len); | |
| 602 if ('!' == ch) | |
| 603 break; | |
| 604 | |
| 605 #ifdef __DEVELOPER__ | |
| 606 if (!((ch >= '0' && ch <= '9'))){ | |
| 607 diag_printf("CHAR: %02x\n", ch); | |
| 608 } | |
| 609 #endif | |
| 610 | |
| 611 CYG_TEST_CHECK((ch >= '0' && ch <= '9'), | |
| 612 "Illegal CRC format from host"); | |
| 613 | |
| 614 crc = crc*10 + (ch - '0'); | |
| 615 } | |
| 616 | |
| 617 return crc; | |
| 618 } | |
| 619 | |
| 620 //--------------------------------------------------------------------------- | |
| 621 // Test binary data transmission. | |
| 622 // Format out: | |
| 623 // "@BINARY:<byte size>:<mode>!" | |
| 624 // Format in: | |
| 625 // <checksum>!<#size bytes data> | |
| 626 // For echo modes, also: | |
| 627 // Format out: | |
| 628 // <#size bytes data> | |
| 629 // Format in: | |
| 630 // OK/ER | |
| 631 // Format out: | |
| 632 // DONE | |
| 633 // | |
| 634 // The last DONE allows the host to eat bytes if target is sending too many. | |
| 635 // | |
| 636 // Mode: | |
| 637 // MODE_NO_ECHO: | |
| 638 // Just receive data and verify CRC. | |
| 639 // MODE_EOP_ECHO: | |
| 640 // Receive data, verify CRC, resend data. | |
| 641 // Expect OK/ER reply from host when done. | |
| 642 // MODE_DUPLEX_ECHO: | |
| 643 // Receive data, echo data, verify CRC. | |
| 644 // Expect OK/ER reply from host when done. | |
| 645 // | |
| 646 // Note: | |
| 647 // Using diag_printf while talking with the host may cause some funky | |
| 648 // errors (bytes from the host side being lost!?!?) | |
| 649 // | |
| 650 // To Do: | |
| 651 // MODE_DUPLEX_ECHO: | |
| 652 // The current implementation is simple and may not stress the | |
| 653 // driver enough. Also, it's command packet format doesn't match | |
| 654 // that of the other modes. | |
| 655 cyg_test_return_t | |
| 656 test_binary(cyg_io_handle_t handle, int size, cyg_mode_t mode) | |
| 657 { | |
| 658 const char cmd[] = "@BINARY:"; | |
| 659 int msglen; | |
| 660 cyg_uint32 xcrc; | |
| 661 int icrc, host_crc; | |
| 662 cyg_uint8 *p1; | |
| 663 cyg_int8 host_status = 'O'; // host is happy by default | |
| 664 | |
| 665 // Verify that the test can be run with available ressources. | |
| 666 if (MODE_EOP_ECHO == mode && size > IN_BUFFER_SIZE) | |
| 667 return TEST_RETURN_NA; | |
| 668 | |
| 669 // Prepare and send the command. | |
| 670 p1 = &cmd_buffer[0]; | |
| 671 p1 = strcpy(p1, &cmd[0]); | |
| 672 p1 = itoa(p1, size); | |
| 673 *p1++ = ':'; | |
| 674 p1 = itoa(p1, mode); | |
| 675 *p1++ = '!'; | |
| 676 *p1++ = 0; | |
| 677 | |
| 678 CYG_TEST_INFO(&cmd_buffer[1]); | |
| 679 | |
| 680 msglen = strlen(&cmd_buffer[0]); | |
| 681 Tcyg_io_write(handle, &cmd_buffer[0], &msglen); | |
| 682 | |
| 683 // Get CRC back. | |
| 684 host_crc = read_host_crc(handle); | |
| 685 | |
| 686 // Depending on mode, start reading data. | |
| 687 xcrc = 0; | |
| 688 switch (mode) { | |
| 689 case MODE_NO_ECHO: | |
| 690 { | |
| 691 // Break transfers into chunks no larger than the buffer size. | |
| 692 int tx_len, chunk_len, i; | |
| 693 while (size > 0) { | |
| 694 chunk_len = min(IN_BUFFER_SIZE, size); | |
| 695 tx_len = chunk_len; | |
| 696 size -= chunk_len; | |
| 697 | |
| 698 Tcyg_io_read(handle, &in_buffer[0], &chunk_len); | |
| 699 | |
| 700 for (i = 0; i < tx_len; i++) { | |
| 701 ADD_CRC_BYTE(xcrc, in_buffer[i]); | |
| 702 } | |
| 703 } | |
| 704 | |
| 705 // Reply that we have completed the test. | |
| 706 { | |
| 707 const char msg_done[] = "DONE"; | |
| 708 | |
| 709 chunk_len = strlen(&msg_done[0]); | |
| 710 Tcyg_io_write(handle, &msg_done[0], &chunk_len); | |
| 711 } | |
| 712 | |
| 713 } | |
| 714 break; | |
| 715 case MODE_EOP_ECHO: | |
| 716 { | |
| 717 // We have already checked that the in buffer is large enough. | |
| 718 int i, tx_len, chunk_len; | |
| 719 chunk_len = tx_len = size; | |
| 720 Tcyg_io_read(handle, &in_buffer[0], &chunk_len); | |
| 721 | |
| 722 for (i = 0; i < tx_len; i++) { | |
| 723 ADD_CRC_BYTE(xcrc, in_buffer[i]); | |
| 724 } | |
| 725 | |
| 726 // Echo data back. | |
| 727 chunk_len = size; | |
| 728 Tcyg_io_write(handle, &in_buffer[0], &chunk_len); | |
| 729 | |
| 730 // Now read host side's status | |
| 731 chunk_len = 2; | |
| 732 Tcyg_io_read(handle, &in_buffer[0], &chunk_len); | |
| 733 host_status = in_buffer[0]; | |
| 734 | |
| 735 // Reply that we have completed the test. | |
| 736 { | |
| 737 const char msg_done[] = "DONE"; | |
| 738 | |
| 739 chunk_len = strlen(&msg_done[0]); | |
| 740 Tcyg_io_write(handle, &msg_done[0], &chunk_len); | |
| 741 } | |
| 742 } | |
| 743 break; | |
| 744 case MODE_DUPLEX_ECHO: | |
| 745 { | |
| 746 int chunk_len; | |
| 747 int block_size = 64; | |
| 748 | |
| 749 // This is a simple implementation (maybe too simple). | |
| 750 // Host sends 4 packets with the same size (64 bytes atm). | |
| 751 // Target echoes in this way: | |
| 752 // packet1 -> packet1 | |
| 753 // packet2 -> packet2, packet2 | |
| 754 // packet3 -> packet3 | |
| 755 // packet4 -> /dev/null | |
| 756 // | |
| 757 // The reads/writes are interleaved in a way that should ensure | |
| 758 // the target out buffer to be full before the target starts to read | |
| 759 // packet3. That is, the target should be both receiving (packet3) | |
| 760 // and sending (packet2) at the same time. | |
| 761 | |
| 762 while (size--) { | |
| 763 // block_size -> block_size | |
| 764 chunk_len = block_size; | |
| 765 Tcyg_io_read(handle, &in_buffer[0], &chunk_len); | |
| 766 chunk_len = block_size; | |
| 767 Tcyg_io_write(handle, &in_buffer[0], &chunk_len); | |
| 768 | |
| 769 // block_size -> 2 x block_size | |
| 770 chunk_len = block_size; | |
| 771 Tcyg_io_read(handle, &in_buffer[0], &chunk_len); | |
| 772 chunk_len = block_size; | |
| 773 Tcyg_io_write(handle, &in_buffer[0], &chunk_len); | |
| 774 chunk_len = block_size; | |
| 775 Tcyg_io_write(handle, &in_buffer[0], &chunk_len); | |
| 776 | |
| 777 // block_size -> block_size | |
| 778 chunk_len = block_size; | |
| 779 Tcyg_io_read(handle, &in_buffer[0], &chunk_len); | |
| 780 chunk_len = block_size; | |
| 781 Tcyg_io_write(handle, &in_buffer[0], &chunk_len); | |
| 782 | |
| 783 // block_size -> 0 | |
| 784 chunk_len = block_size; | |
| 785 Tcyg_io_read(handle, &in_buffer[0], &chunk_len); | |
| 786 } | |
| 787 | |
| 788 // Kill the CRC. Leave packet verification to the host for now. | |
| 789 xcrc = host_crc = 0; | |
| 790 | |
| 791 // Now read host side's status | |
| 792 chunk_len = 2; | |
| 793 Tcyg_io_read(handle, &in_buffer[0], &chunk_len); | |
| 794 host_status = in_buffer[0]; | |
| 795 | |
| 796 // Reply that we have completed the test. | |
| 797 { | |
| 798 const char msg_done[] = "DONE"; | |
| 799 | |
| 800 chunk_len = strlen(&msg_done[0]); | |
| 801 Tcyg_io_write(handle, &msg_done[0], &chunk_len); | |
| 802 } | |
| 803 } | |
| 804 break; | |
| 805 default: | |
| 806 CYG_TEST_CHECK(0, "unknown mode"); | |
| 807 } | |
| 808 | |
| 809 | |
| 810 // Verify that the CRC matches the one from the host. | |
| 811 FIX_CRC(xcrc, icrc); | |
| 812 #ifdef __DEVELOPER__ | |
| 813 if (host_crc != icrc) | |
| 814 diag_printf("%d != %d\n", icrc, host_crc); | |
| 815 #endif | |
| 816 CYG_TEST_CHECK(host_crc == icrc, "CRC failed!"); | |
| 817 | |
| 818 // Verify that the host is happy with the data we echoed. | |
| 819 CYG_TEST_CHECK('O' == host_status, "Host failed checksum on echoed data"); | |
| 820 | |
| 821 CYG_TEST_PASS("Binary test completed"); | |
| 822 return TEST_RETURN_OK; | |
| 823 } | |
| 824 | |
| 825 //--------------------------------------------------------------------------- | |
| 826 // Test transformations on text transmissions | |
| 827 // Format out: | |
| 828 // "@TEXT:<mode>!<4 bytes binary checksum><C string>" | |
| 829 // Format in: | |
| 830 // "<C string>" | |
| 831 // OK/ER | |
| 832 // | |
| 833 // Mode: | |
| 834 // MODE_EOP_ECHO: | |
| 835 // Receive data, verify CRC, resend data. | |
| 836 // Expect OK/ER reply from host when done. | |
| 837 // MODE_DUPLEX_ECHO: | |
| 838 // Receive data, echo data, verify CRC. | |
| 839 // Expect OK/ER reply from host when done. | |
| 840 // | |
| 841 cyg_test_return_t | |
| 842 test_text(cyg_io_handle_t handle, cyg_mode_t mode, const char* s_base, | |
| 843 const char* s_out, const char* s_in) | |
| 844 { | |
| 845 return TEST_RETURN_NA; | |
| 846 } | |
| 847 | |
| 848 //--------------------------------------------------------------------------- | |
| 849 // Send PING to host, verifying the filter's presence. | |
| 850 // Format out: | |
| 851 // "@PING!" | |
| 852 // Format in: | |
| 853 // "OK" | |
| 854 // or | |
| 855 // No response if directly connected to GDB. | |
| 856 // | |
| 857 // This call only returns if the ser_filter is listening. Otherwise it | |
| 858 // sends N/A and hangs. | |
| 859 void | |
| 860 test_ping(cyg_io_handle_t handle) | |
| 861 { | |
| 862 char msg[] = "@PING:!"; | |
| 863 char msg2[] = "\n"; | |
| 864 int msglen = strlen(msg); | |
| 865 int res; | |
| 866 | |
| 867 msglen = strlen(msg); | |
| 868 Tcyg_io_write(handle, msg, &msglen); | |
| 869 | |
| 870 // Now read host side's status | |
| 871 msglen = 2; | |
| 872 Tcyg_io_read_timeout(handle, &in_buffer[0], &msglen, 100, &res); | |
| 873 if (ENOERR == res && 'O' == in_buffer[0] && 'K' == in_buffer[1]) | |
| 874 return; | |
| 875 | |
| 876 msglen = strlen(msg2); | |
| 877 Tcyg_io_write(handle, msg2, &msglen); | |
| 878 | |
| 879 CYG_TEST_NA("No host side testing harness detected."); | |
| 880 } | |
| 881 | |
| 882 //--------------------------------------------------------------------------- | |
| 883 // Some helper functions to get a test started. | |
| 884 void | |
| 885 test_open_ser( cyg_io_handle_t* handle ) | |
| 886 { | |
| 887 #ifndef SER_NOP_TEST | |
| 888 Cyg_ErrNo res; | |
| 889 | |
| 890 if (cyg_test_is_simulator) | |
| 891 CYG_TEST_NA("Cannot run from simulator"); | |
| 892 | |
| 893 #if defined(HAL_VSR_SET_TO_ECOS_HANDLER) | |
| 894 # if defined(SER_OVERRIDE_INT_1) | |
| 895 HAL_VSR_SET_TO_ECOS_HANDLER(SER_OVERRIDE_INT_1, NULL); | |
| 896 # endif | |
| 897 # if defined(SER_OVERRIDE_INT_2) | |
| 898 HAL_VSR_SET_TO_ECOS_HANDLER(SER_OVERRIDE_INT_2, NULL); | |
| 899 # endif | |
| 900 #endif | |
| 901 | |
| 902 res = cyg_io_lookup(TEST_SER_DEV, handle); | |
| 903 if (res != ENOERR) { | |
| 904 CYG_TEST_FAIL_FINISH("Can't lookup " TEST_SER_DEV); | |
| 905 } | |
| 906 #else | |
|
4
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
907 CYG_TEST_NA(NA_MSG); |
| 2 | 908 #endif |
| 909 } | |
| 910 | |
| 911 void | |
| 912 test_open_tty( cyg_io_handle_t* handle ) | |
| 913 { | |
| 914 #ifndef TTY_NOP_TEST | |
| 915 Cyg_ErrNo res; | |
| 916 | |
| 917 if (cyg_test_is_simulator) | |
| 918 CYG_TEST_NA("Cannot run from simulator"); | |
| 919 | |
| 920 #if defined(HAL_VSR_SET_TO_ECOS_HANDLER) | |
| 921 # if defined(SER_OVERRIDE_INT_1) | |
| 922 HAL_VSR_SET_TO_ECOS_HANDLER(SER_OVERRIDE_INT_1, NULL); | |
| 923 # endif | |
| 924 # if defined(SER_OVERRIDE_INT_2) | |
| 925 HAL_VSR_SET_TO_ECOS_HANDLER(SER_OVERRIDE_INT_2, NULL); | |
| 926 # endif | |
| 927 #endif | |
| 928 | |
| 929 res = cyg_io_lookup(TEST_TTY_DEV, handle); | |
| 930 if (res != ENOERR) { | |
| 931 CYG_TEST_FAIL_FINISH("Can't lookup " TEST_TTY_DEV); | |
| 932 } | |
| 933 #else | |
|
4
1d7f19c9e4d1
Merge from eCos master repository on 1999-05-11-21:11:10-BST
jlarmour
parents:
2
diff
changeset
|
934 CYG_TEST_NA(NA_MSG); |
| 2 | 935 #endif |
| 936 } | |
| 937 | |
| 938 //--------------------------------------------------------------------------- | |
| 939 // end of ser_test_protocol.inl |