Mercurial > ecos
annotate packages/hal/common/current/src/drv_api.c @ 156:b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
| author | jlarmour |
|---|---|
| date | Fri, 06 Apr 2001 17:20:13 +0000 |
| parents | 25e238959bae |
| children | ac086aa3217e |
| rev | line source |
|---|---|
| 2 | 1 //========================================================================== |
| 2 // | |
| 3 // drv_api.c | |
| 4 // | |
| 5 // Driver API for non-kernel configurations | |
| 6 // | |
| 7 //========================================================================== | |
| 8 //####COPYRIGHTBEGIN#### | |
|
64
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
6
diff
changeset
|
9 // |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
6
diff
changeset
|
10 // ------------------------------------------- |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
6
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:
6
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:
6
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:
6
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:
6
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:
6
diff
changeset
|
19 // the License. |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
6
diff
changeset
|
20 // |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
6
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:
6
diff
changeset
|
22 // released September 30, 1998. |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
6
diff
changeset
|
23 // |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
6
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:
6
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:
6
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:
6
diff
changeset
|
27 // All Rights Reserved. |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
6
diff
changeset
|
28 // ------------------------------------------- |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
6
diff
changeset
|
29 // |
| 2 | 30 //####COPYRIGHTEND#### |
| 31 //========================================================================== | |
| 32 //#####DESCRIPTIONBEGIN#### | |
| 33 // | |
| 34 // Author(s): Nick Garnett | |
| 35 // Date: 1999-02-24 | |
| 36 // Purpose: Driver API for non-kernel configurations | |
| 37 // Description: These functions are used to support drivers when the kernel | |
| 38 // is not present. | |
| 39 // | |
| 40 // | |
| 41 // | |
| 42 //####DESCRIPTIONEND#### | |
| 43 // | |
| 44 //========================================================================== | |
| 45 | |
| 46 #include <pkgconf/system.h> | |
| 47 | |
| 48 #ifndef CYGPKG_KERNEL | |
| 49 | |
| 50 #include <cyg/infra/cyg_type.h> | |
| 51 #include <cyg/infra/cyg_trac.h> | |
| 52 #include <cyg/infra/cyg_ass.h> | |
| 53 | |
| 54 #include <pkgconf/hal.h> | |
| 55 #include <cyg/hal/drv_api.h> | |
| 56 | |
| 57 #include <cyg/hal/hal_arch.h> | |
| 58 #include <cyg/hal/hal_intr.h> | |
| 59 | |
| 60 //-------------------------------------------------------------------------- | |
| 61 // Statics | |
| 62 | |
|
149
52c99470ec11
Merge from eCos master repository on 2001-01-19-06:43:03-GMT
jlarmour
parents:
130
diff
changeset
|
63 static volatile cyg_int32 isr_disable_counter = 1; // ISR disable counter |
| 2 | 64 |
|
156
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
151
diff
changeset
|
65 volatile cyg_int32 dsr_disable_counter // DSR disable counter |
|
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
151
diff
changeset
|
66 CYGBLD_ATTRIB_ASM_ALIAS( cyg_scheduler_sched_lock ); |
| 2 | 67 |
|
130
eb9fd8c04db3
Merge from eCos master repository on 2000-10-23-17:01:37-BST
jlarmour
parents:
115
diff
changeset
|
68 static cyg_interrupt* volatile dsr_list; // List of pending DSRs |
| 2 | 69 |
| 70 #ifdef CYGIMP_HAL_COMMON_INTERRUPTS_CHAIN | |
| 71 | |
| 72 cyg_interrupt *chain_list[CYGNUM_HAL_ISR_COUNT]; | |
| 73 | |
| 74 #endif | |
| 75 | |
| 76 //-------------------------------------------------------------------------- | |
| 77 // DSR handling functions. | |
| 78 // post_dsr() places a DSR on the list of DSRs to be called. | |
| 79 // call_dsrs() calls the DSRs. | |
| 80 | |
| 81 static void post_dsr( cyg_interrupt *intr ) | |
| 82 { | |
| 83 CYG_INTERRUPT_STATE old_intr; | |
| 84 | |
| 85 CYG_REPORT_FUNCTION(); | |
| 86 | |
| 87 HAL_DISABLE_INTERRUPTS(old_intr); | |
| 88 | |
|
130
eb9fd8c04db3
Merge from eCos master repository on 2000-10-23-17:01:37-BST
jlarmour
parents:
115
diff
changeset
|
89 if( intr->dsr_count++ == 0 ) |
| 2 | 90 { |
| 91 intr->next_dsr = dsr_list; | |
| 92 dsr_list = intr; | |
| 93 } | |
| 94 | |
| 95 HAL_RESTORE_INTERRUPTS(old_intr); | |
| 96 | |
| 97 CYG_REPORT_RETURN(); | |
| 98 } | |
| 99 | |
| 100 static void call_dsrs(void) | |
| 101 { | |
| 102 CYG_REPORT_FUNCTION(); | |
| 103 | |
| 104 while( dsr_list != NULL ) | |
| 105 { | |
|
130
eb9fd8c04db3
Merge from eCos master repository on 2000-10-23-17:01:37-BST
jlarmour
parents:
115
diff
changeset
|
106 cyg_interrupt *intr; |
| 2 | 107 cyg_int32 count; |
| 108 CYG_INTERRUPT_STATE old_intr; | |
| 109 | |
| 110 HAL_DISABLE_INTERRUPTS(old_intr); | |
| 111 | |
| 112 intr = dsr_list; | |
| 113 dsr_list = intr->next_dsr; | |
| 114 count = intr->dsr_count; | |
| 115 intr->dsr_count = 0; | |
| 116 | |
| 117 HAL_RESTORE_INTERRUPTS(old_intr); | |
| 118 | |
| 119 intr->dsr( intr->vector, count, (CYG_ADDRWORD)intr->data ); | |
| 120 } | |
| 121 | |
| 122 CYG_REPORT_RETURN(); | |
| 123 | |
| 124 } | |
| 125 | |
| 126 //-------------------------------------------------------------------------- | |
|
6
d376b777e2ce
Merge from eCos master repository on 1999-05-14-19:27:43-BST
jlarmour
parents:
2
diff
changeset
|
127 // This is referenced from the HAL, although it does not actually get called. |
|
d376b777e2ce
Merge from eCos master repository on 1999-05-14-19:27:43-BST
jlarmour
parents:
2
diff
changeset
|
128 |
|
d376b777e2ce
Merge from eCos master repository on 1999-05-14-19:27:43-BST
jlarmour
parents:
2
diff
changeset
|
129 externC void |
|
d376b777e2ce
Merge from eCos master repository on 1999-05-14-19:27:43-BST
jlarmour
parents:
2
diff
changeset
|
130 cyg_interrupt_call_pending_DSRs(void) |
|
d376b777e2ce
Merge from eCos master repository on 1999-05-14-19:27:43-BST
jlarmour
parents:
2
diff
changeset
|
131 { |
|
d376b777e2ce
Merge from eCos master repository on 1999-05-14-19:27:43-BST
jlarmour
parents:
2
diff
changeset
|
132 call_dsrs(); |
|
d376b777e2ce
Merge from eCos master repository on 1999-05-14-19:27:43-BST
jlarmour
parents:
2
diff
changeset
|
133 } |
|
d376b777e2ce
Merge from eCos master repository on 1999-05-14-19:27:43-BST
jlarmour
parents:
2
diff
changeset
|
134 |
|
d376b777e2ce
Merge from eCos master repository on 1999-05-14-19:27:43-BST
jlarmour
parents:
2
diff
changeset
|
135 |
|
d376b777e2ce
Merge from eCos master repository on 1999-05-14-19:27:43-BST
jlarmour
parents:
2
diff
changeset
|
136 //-------------------------------------------------------------------------- |
| 2 | 137 // Interrupt end function called from HAL VSR to tidy up. This is where |
| 138 // DSRs will be called if necessary. | |
| 139 | |
| 140 externC void | |
| 141 interrupt_end( | |
| 142 cyg_uint32 isr_ret, | |
| 143 cyg_interrupt *intr, | |
| 144 HAL_SavedRegisters *regs | |
| 145 ) | |
| 146 { | |
| 147 CYG_REPORT_FUNCTION(); | |
| 148 | |
| 149 #ifndef CYGIMP_HAL_COMMON_INTERRUPTS_CHAIN | |
| 150 | |
| 151 // Only do this if we are in a non-chained configuration. | |
| 152 // If we are chained, then chain_isr will do the DSR | |
| 153 // posting. | |
| 154 | |
| 155 if( isr_ret & CYG_ISR_CALL_DSR && intr != NULL ) post_dsr(intr); | |
| 156 | |
| 157 #endif | |
| 158 | |
| 159 if( dsr_disable_counter == 0 ) call_dsrs(); | |
| 160 | |
| 161 CYG_REPORT_RETURN(); | |
| 162 } | |
| 163 | |
| 164 //-------------------------------------------------------------------------- | |
| 165 // ISR for handling chained interrupts. | |
| 166 | |
| 167 #ifdef CYGIMP_HAL_COMMON_INTERRUPTS_CHAIN | |
| 168 | |
| 169 cyg_uint32 chain_isr(cyg_vector_t vector, CYG_ADDRWORD data) | |
| 170 { | |
|
151
25e238959bae
Merge from eCos master repository on 2001-02-12-23:44:24-GMT
jlarmour
parents:
149
diff
changeset
|
171 cyg_interrupt *p = *(cyg_interrupt **)data; |
|
25e238959bae
Merge from eCos master repository on 2001-02-12-23:44:24-GMT
jlarmour
parents:
149
diff
changeset
|
172 |
| 2 | 173 CYG_REPORT_FUNCTION(); |
| 174 | |
| 175 while( p != NULL ) | |
| 176 { | |
| 177 if( p->vector == vector ) | |
| 178 { | |
| 179 register cyg_uint32 isr_ret = p->isr(vector, p->data); | |
| 180 | |
| 181 if( isr_ret & CYG_ISR_CALL_DSR ) post_dsr(p); | |
| 182 | |
| 183 if( isr_ret & CYG_ISR_HANDLED ) break; | |
| 184 } | |
| 185 | |
| 186 p = p->next; | |
| 187 } | |
| 188 | |
| 189 CYG_REPORT_RETURN(); | |
| 190 | |
| 191 return 0; | |
| 192 } | |
| 193 | |
| 194 #endif | |
| 195 | |
| 196 //-------------------------------------------------------------------------- | |
| 197 // ISR lock. This disables interrupts and keeps a count of the number | |
| 198 // times it has been called. | |
| 199 | |
| 200 externC void cyg_drv_isr_lock() | |
| 201 { | |
| 202 CYG_INTERRUPT_STATE dummy; | |
| 203 | |
| 204 CYG_REPORT_FUNCTION(); | |
| 205 | |
| 206 HAL_DISABLE_INTERRUPTS(dummy); | |
| 207 | |
| 208 CYG_ASSERT( isr_disable_counter >= 0 , "Disable counter negative"); | |
| 209 | |
| 210 isr_disable_counter++; | |
| 211 | |
| 212 CYG_REPORT_RETURN(); | |
| 213 } | |
| 214 | |
| 215 //-------------------------------------------------------------------------- | |
| 216 // Unlock ISRs. This decrements the count and re-enables interrupts if it | |
| 217 // goes zero. | |
| 218 | |
| 219 externC void cyg_drv_isr_unlock() | |
| 220 { | |
| 221 CYG_REPORT_FUNCTION(); | |
| 222 | |
| 223 CYG_ASSERT( isr_disable_counter > 0 , "Disable counter not greater than zero"); | |
| 224 | |
| 225 isr_disable_counter--; | |
| 226 | |
| 227 if ( isr_disable_counter == 0 ) | |
| 228 { | |
| 229 HAL_ENABLE_INTERRUPTS(); | |
| 230 } | |
| 231 | |
| 232 CYG_REPORT_RETURN(); | |
| 233 } | |
| 234 | |
| 235 //-------------------------------------------------------------------------- | |
| 236 // Lock DSR lock. Simply increment the counter. | |
| 237 | |
| 238 externC void cyg_drv_dsr_lock() | |
| 239 { | |
| 240 CYG_REPORT_FUNCTION(); | |
| 241 | |
| 242 dsr_disable_counter++; | |
| 243 | |
| 244 CYG_REPORT_RETURN(); | |
| 245 } | |
| 246 | |
| 247 //-------------------------------------------------------------------------- | |
| 248 // Unlock DSR lock. If the counter is about to go zero, call any pending | |
| 249 // DSRs and then zero the counter. | |
| 250 | |
| 251 externC void cyg_drv_dsr_unlock() | |
| 252 { | |
| 253 CYG_REPORT_FUNCTION(); | |
| 254 | |
| 255 do | |
| 256 { | |
| 257 if( dsr_disable_counter == 1 ) | |
| 258 { | |
| 259 call_dsrs(); | |
| 260 } | |
| 261 | |
| 262 HAL_REORDER_BARRIER(); | |
| 263 | |
| 264 dsr_disable_counter = 0; | |
| 265 | |
| 266 HAL_REORDER_BARRIER(); | |
| 267 | |
| 268 // Check that no DSRs have been posted between calling | |
| 269 // call_dsrs() and zeroing dsr_disable_counter. If so, | |
| 270 // loop back and call them. | |
| 271 | |
| 272 if( dsr_list != NULL ) | |
| 273 { | |
| 274 dsr_disable_counter = 1; | |
| 275 continue; | |
| 276 } | |
| 277 | |
| 278 CYG_REPORT_RETURN(); | |
| 279 | |
| 280 return; | |
| 281 | |
| 282 } while(1); | |
| 283 | |
| 284 CYG_FAIL( "Should not be executed" ); | |
| 285 } | |
| 286 | |
| 287 //-------------------------------------------------------------------------- | |
| 288 // Initialize a mutex. | |
| 289 | |
| 290 externC void cyg_drv_mutex_init( cyg_drv_mutex_t *mutex ) | |
| 291 { | |
| 292 CYG_REPORT_FUNCTION(); | |
| 293 | |
| 294 mutex->lock = 0; | |
| 295 | |
| 296 CYG_REPORT_RETURN(); | |
| 297 } | |
| 298 | |
| 299 //-------------------------------------------------------------------------- | |
| 300 // Destroy a mutex. | |
| 301 | |
| 302 externC void cyg_drv_mutex_destroy( cyg_drv_mutex_t *mutex ) | |
| 303 { | |
| 304 CYG_REPORT_FUNCTION(); | |
| 305 | |
| 306 mutex->lock = -1; | |
| 307 | |
| 308 CYG_REPORT_RETURN(); | |
| 309 } | |
| 310 | |
| 311 //-------------------------------------------------------------------------- | |
| 312 // Lock a mutex. We check that we are not trying to lock a locked or | |
| 313 // destroyed mutex and if not, set it locked. | |
| 314 | |
| 315 externC cyg_bool_t cyg_drv_mutex_lock( cyg_drv_mutex_t *mutex ) | |
| 316 { | |
| 317 CYG_REPORT_FUNCTION(); | |
| 318 | |
| 319 CYG_ASSERT( mutex->lock == 0 , "Trying to lock locked mutex"); | |
| 320 | |
| 321 mutex->lock = 1; | |
| 322 | |
| 323 CYG_REPORT_RETURN(); | |
| 324 | |
| 325 return true; | |
| 326 } | |
| 327 | |
| 328 //-------------------------------------------------------------------------- | |
| 329 // Attempt to claim a mutex, and return if it cannot be. | |
| 330 | |
| 331 externC cyg_bool_t cyg_drv_mutex_trylock( cyg_drv_mutex_t *mutex ) | |
| 332 { | |
| 333 cyg_bool_t result = true; | |
| 334 | |
| 335 CYG_REPORT_FUNCTION(); | |
| 336 | |
| 337 if( mutex->lock == 1 ) result = false; | |
| 338 | |
| 339 CYG_REPORT_RETURN(); | |
| 340 | |
| 341 return result; | |
| 342 } | |
| 343 | |
| 344 //-------------------------------------------------------------------------- | |
| 345 // Unlock a mutex. We check that the mutex is actually locked before doing | |
| 346 // this. | |
| 347 | |
| 348 externC void cyg_drv_mutex_unlock( cyg_drv_mutex_t *mutex ) | |
| 349 { | |
| 350 CYG_REPORT_FUNCTION(); | |
| 351 | |
| 352 CYG_ASSERT( mutex->lock == 1 , "Trying to unlock unlocked mutex"); | |
| 353 | |
| 354 mutex->lock = 0; | |
| 355 | |
| 356 CYG_REPORT_RETURN(); | |
| 357 } | |
| 358 | |
| 359 //-------------------------------------------------------------------------- | |
| 360 // Release all threads waiting for the mutex. | |
| 361 // This is really for threads, so we do nothing here. | |
| 362 | |
| 363 externC void cyg_drv_mutex_release( cyg_drv_mutex_t *mutex ) | |
| 364 { | |
| 365 CYG_REPORT_FUNCTION(); | |
| 366 | |
| 367 | |
| 368 | |
| 369 CYG_REPORT_RETURN(); | |
| 370 } | |
| 371 | |
| 372 | |
| 373 //-------------------------------------------------------------------------- | |
| 374 // Initialized a condition variable. | |
| 375 | |
| 376 externC void cyg_drv_cond_init( cyg_drv_cond_t *cond, cyg_drv_mutex_t *mutex ) | |
| 377 { | |
| 378 CYG_REPORT_FUNCTION(); | |
| 379 | |
| 380 cond->wait = 0; | |
| 381 cond->mutex = mutex; | |
| 382 | |
| 383 CYG_REPORT_RETURN(); | |
| 384 } | |
| 385 | |
| 386 | |
| 387 //-------------------------------------------------------------------------- | |
| 388 // Destroy a condition variable. | |
| 389 | |
| 390 externC void cyg_drv_cond_destroy( cyg_drv_cond_t *cond ) | |
| 391 { | |
| 392 CYG_REPORT_FUNCTION(); | |
| 393 | |
| 394 cond->wait = -1; | |
| 395 cond->mutex = NULL; | |
| 396 | |
| 397 CYG_REPORT_RETURN(); | |
| 398 } | |
| 399 | |
| 400 // ------------------------------------------------------------------------- | |
| 401 // Wait for a condition variable to be signalled. We simply busy wait | |
| 402 // polling the condition variable's wait member until a DSR sets it to | |
| 403 // 0. Note that the semantics of condition variables means that the | |
| 404 // wakeup only happens if there is a thread actually waiting on the CV | |
| 405 // when the signal is sent. | |
| 406 | |
|
115
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
66
diff
changeset
|
407 externC cyg_bool cyg_drv_cond_wait( cyg_drv_cond_t *cond ) |
| 2 | 408 { |
| 409 CYG_REPORT_FUNCTION(); | |
| 410 | |
| 411 CYG_ASSERT( cond->mutex != NULL, "Uninitialized condition variable"); | |
| 412 CYG_ASSERT( cond->mutex->lock, "Mutex not locked"); | |
| 413 | |
| 414 cyg_drv_dsr_lock(); | |
| 415 | |
| 416 cond->wait = 1; | |
| 417 | |
| 418 while( cond->wait == 1 ) | |
| 419 { | |
| 420 // While looping we call call_dsrs() to service any DSRs that | |
| 421 // get posted. One of these will make the call to cond_signal | |
| 422 // to break us out of this loop. If we do not have the DSR | |
| 423 // lock claimed, then a race condition could occur and keep us | |
| 424 // stuck here forever. | |
| 425 | |
| 426 call_dsrs(); | |
| 427 } | |
| 428 | |
| 429 cyg_drv_dsr_unlock(); | |
| 430 | |
|
115
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
66
diff
changeset
|
431 CYG_REPORT_RETURN(); |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
66
diff
changeset
|
432 |
|
6ed91473a1cd
Merge from eCos master repository on 2000-08-21-22:40:54-BST
jlarmour
parents:
66
diff
changeset
|
433 return true; |
| 2 | 434 } |
| 435 | |
| 436 //-------------------------------------------------------------------------- | |
| 437 // Signal a condition variable. This sets the wait member to zero, which | |
| 438 // has no effect when there is no waiter, but will wake up any waiting | |
| 439 // thread. | |
| 440 | |
| 441 externC void cyg_drv_cond_signal( cyg_drv_cond_t *cond ) | |
| 442 { | |
| 443 CYG_REPORT_FUNCTION(); | |
| 444 | |
| 445 cond->wait = 0; | |
| 446 | |
| 447 CYG_REPORT_RETURN(); | |
| 448 } | |
| 449 | |
| 450 | |
| 451 //-------------------------------------------------------------------------- | |
| 452 // Broadcast to condition variable. This is exactly the same a signal since | |
| 453 // there can only be one waiter. | |
| 454 | |
| 455 externC void cyg_drv_cond_broadcast( cyg_drv_cond_t *cond ) | |
| 456 { | |
| 457 CYG_REPORT_FUNCTION(); | |
| 458 | |
| 459 cond->wait = 0; | |
| 460 | |
| 461 CYG_REPORT_RETURN(); | |
| 462 } | |
| 463 | |
| 464 | |
| 465 //-------------------------------------------------------------------------- | |
| 466 // Create an interrupt object. | |
| 467 | |
| 468 externC void cyg_drv_interrupt_create( | |
| 469 cyg_vector_t vector, | |
| 470 cyg_priority_t priority, | |
| 471 cyg_addrword_t data, | |
| 472 cyg_ISR_t *isr, | |
| 473 cyg_DSR_t *dsr, | |
| 474 cyg_handle_t *handle, | |
| 475 cyg_interrupt *intr | |
| 476 ) | |
| 477 { | |
| 478 CYG_REPORT_FUNCTION(); | |
| 479 | |
| 480 intr->vector = vector; | |
| 481 intr->priority = priority; | |
| 482 intr->isr = isr; | |
| 483 intr->dsr = dsr; | |
| 484 intr->data = data; | |
| 485 intr->next_dsr = NULL; | |
| 486 intr->dsr_count = 0; | |
| 487 | |
| 488 #ifdef CYGIMP_HAL_COMMON_INTERRUPTS_CHAIN | |
| 489 | |
| 490 intr->next = NULL; | |
| 491 | |
| 492 #endif | |
| 493 | |
| 494 *handle = (cyg_handle_t)intr; | |
| 495 | |
| 496 CYG_REPORT_RETURN(); | |
| 497 } | |
| 498 | |
| 499 //-------------------------------------------------------------------------- | |
| 500 // Delete an interrupt object. This merely ensures that it is detached from | |
| 501 // the vector. | |
| 502 | |
| 503 externC void cyg_drv_interrupt_delete( cyg_handle_t interrupt ) | |
| 504 { | |
| 505 CYG_REPORT_FUNCTION(); | |
| 506 | |
| 507 cyg_drv_interrupt_detach( interrupt ); | |
| 508 | |
| 509 CYG_REPORT_RETURN(); | |
| 510 } | |
| 511 | |
| 512 //-------------------------------------------------------------------------- | |
| 513 // | |
| 514 | |
| 515 externC void cyg_drv_interrupt_attach( cyg_handle_t interrupt ) | |
| 516 { | |
| 517 cyg_interrupt *intr = (cyg_interrupt *)interrupt; | |
| 518 | |
| 519 CYG_REPORT_FUNCTION(); | |
| 520 | |
| 521 CYG_ASSERT( intr->vector >= CYGNUM_HAL_ISR_MIN, "Invalid vector"); | |
| 522 CYG_ASSERT( intr->vector <= CYGNUM_HAL_ISR_MAX, "Invalid vector"); | |
| 523 | |
| 524 HAL_INTERRUPT_SET_LEVEL( intr->vector, intr->priority ); | |
| 525 | |
| 526 #ifdef CYGIMP_HAL_COMMON_INTERRUPTS_CHAIN | |
| 527 | |
| 528 CYG_ASSERT( intr->next == NULL , "cyg_interrupt already on a list"); | |
| 529 | |
|
151
25e238959bae
Merge from eCos master repository on 2001-02-12-23:44:24-GMT
jlarmour
parents:
149
diff
changeset
|
530 { |
|
25e238959bae
Merge from eCos master repository on 2001-02-12-23:44:24-GMT
jlarmour
parents:
149
diff
changeset
|
531 cyg_uint32 index; |
| 2 | 532 |
|
151
25e238959bae
Merge from eCos master repository on 2001-02-12-23:44:24-GMT
jlarmour
parents:
149
diff
changeset
|
533 HAL_TRANSLATE_VECTOR( intr->vector, index ); |
| 2 | 534 |
|
151
25e238959bae
Merge from eCos master repository on 2001-02-12-23:44:24-GMT
jlarmour
parents:
149
diff
changeset
|
535 if( chain_list[index] == NULL ) |
|
25e238959bae
Merge from eCos master repository on 2001-02-12-23:44:24-GMT
jlarmour
parents:
149
diff
changeset
|
536 { |
|
25e238959bae
Merge from eCos master repository on 2001-02-12-23:44:24-GMT
jlarmour
parents:
149
diff
changeset
|
537 // First Interrupt on this chain, just assign it and |
|
25e238959bae
Merge from eCos master repository on 2001-02-12-23:44:24-GMT
jlarmour
parents:
149
diff
changeset
|
538 // register the chain_isr with the HAL. |
| 2 | 539 |
|
151
25e238959bae
Merge from eCos master repository on 2001-02-12-23:44:24-GMT
jlarmour
parents:
149
diff
changeset
|
540 chain_list[index] = intr; |
| 2 | 541 |
|
151
25e238959bae
Merge from eCos master repository on 2001-02-12-23:44:24-GMT
jlarmour
parents:
149
diff
changeset
|
542 HAL_INTERRUPT_ATTACH( intr->vector, chain_isr, |
|
25e238959bae
Merge from eCos master repository on 2001-02-12-23:44:24-GMT
jlarmour
parents:
149
diff
changeset
|
543 &chain_list[index], NULL ); |
|
25e238959bae
Merge from eCos master repository on 2001-02-12-23:44:24-GMT
jlarmour
parents:
149
diff
changeset
|
544 } |
|
25e238959bae
Merge from eCos master repository on 2001-02-12-23:44:24-GMT
jlarmour
parents:
149
diff
changeset
|
545 else |
|
25e238959bae
Merge from eCos master repository on 2001-02-12-23:44:24-GMT
jlarmour
parents:
149
diff
changeset
|
546 { |
|
25e238959bae
Merge from eCos master repository on 2001-02-12-23:44:24-GMT
jlarmour
parents:
149
diff
changeset
|
547 // There are already interrupts chained, add this one into |
|
25e238959bae
Merge from eCos master repository on 2001-02-12-23:44:24-GMT
jlarmour
parents:
149
diff
changeset
|
548 // the chain in priority order. |
| 2 | 549 |
|
151
25e238959bae
Merge from eCos master repository on 2001-02-12-23:44:24-GMT
jlarmour
parents:
149
diff
changeset
|
550 cyg_interrupt **p = &chain_list[index]; |
| 2 | 551 |
|
151
25e238959bae
Merge from eCos master repository on 2001-02-12-23:44:24-GMT
jlarmour
parents:
149
diff
changeset
|
552 while( *p != NULL ) |
|
25e238959bae
Merge from eCos master repository on 2001-02-12-23:44:24-GMT
jlarmour
parents:
149
diff
changeset
|
553 { |
|
25e238959bae
Merge from eCos master repository on 2001-02-12-23:44:24-GMT
jlarmour
parents:
149
diff
changeset
|
554 cyg_interrupt *n = *p; |
|
25e238959bae
Merge from eCos master repository on 2001-02-12-23:44:24-GMT
jlarmour
parents:
149
diff
changeset
|
555 |
|
25e238959bae
Merge from eCos master repository on 2001-02-12-23:44:24-GMT
jlarmour
parents:
149
diff
changeset
|
556 if( n->priority < intr->priority ) break; |
| 2 | 557 |
|
151
25e238959bae
Merge from eCos master repository on 2001-02-12-23:44:24-GMT
jlarmour
parents:
149
diff
changeset
|
558 p = &n->next; |
|
25e238959bae
Merge from eCos master repository on 2001-02-12-23:44:24-GMT
jlarmour
parents:
149
diff
changeset
|
559 } |
|
25e238959bae
Merge from eCos master repository on 2001-02-12-23:44:24-GMT
jlarmour
parents:
149
diff
changeset
|
560 intr->next = *p; |
|
25e238959bae
Merge from eCos master repository on 2001-02-12-23:44:24-GMT
jlarmour
parents:
149
diff
changeset
|
561 *p = intr; |
| 2 | 562 } |
| 563 } | |
| 564 | |
| 565 #else | |
| 566 | |
| 567 HAL_INTERRUPT_ATTACH( intr->vector, intr->isr, intr->data, intr ); | |
| 568 | |
| 569 #endif | |
| 570 | |
| 571 CYG_REPORT_RETURN(); | |
| 572 } | |
| 573 | |
| 574 | |
| 575 //-------------------------------------------------------------------------- | |
| 576 // Detach an interrupt from its vector. | |
| 577 | |
| 578 externC void cyg_drv_interrupt_detach( cyg_handle_t interrupt ) | |
| 579 { | |
| 580 cyg_interrupt *intr = (cyg_interrupt *)interrupt; | |
| 581 | |
| 582 CYG_REPORT_FUNCTION(); | |
| 583 | |
| 584 CYG_ASSERT( intr->vector >= CYGNUM_HAL_ISR_MIN, "Invalid vector"); | |
| 585 CYG_ASSERT( intr->vector <= CYGNUM_HAL_ISR_MAX, "Invalid vector"); | |
| 586 | |
| 587 #ifdef CYGIMP_HAL_COMMON_INTERRUPTS_CHAIN | |
| 588 | |
| 589 // Remove the interrupt object from the vector chain. | |
| 590 | |
|
151
25e238959bae
Merge from eCos master repository on 2001-02-12-23:44:24-GMT
jlarmour
parents:
149
diff
changeset
|
591 { |
|
25e238959bae
Merge from eCos master repository on 2001-02-12-23:44:24-GMT
jlarmour
parents:
149
diff
changeset
|
592 cyg_uint32 index; |
|
25e238959bae
Merge from eCos master repository on 2001-02-12-23:44:24-GMT
jlarmour
parents:
149
diff
changeset
|
593 cyg_interrupt **p; |
| 2 | 594 |
|
156
b939e9cada46
Merge from eCos master repository on 2001-03-29-21:44:39-BST
jlarmour
parents:
151
diff
changeset
|
595 HAL_TRANSLATE_VECTOR( intr->vector, index ); |
|
151
25e238959bae
Merge from eCos master repository on 2001-02-12-23:44:24-GMT
jlarmour
parents:
149
diff
changeset
|
596 |
|
25e238959bae
Merge from eCos master repository on 2001-02-12-23:44:24-GMT
jlarmour
parents:
149
diff
changeset
|
597 p = &chain_list[index]; |
| 2 | 598 |
|
151
25e238959bae
Merge from eCos master repository on 2001-02-12-23:44:24-GMT
jlarmour
parents:
149
diff
changeset
|
599 while( *p != NULL ) |
| 2 | 600 { |
|
151
25e238959bae
Merge from eCos master repository on 2001-02-12-23:44:24-GMT
jlarmour
parents:
149
diff
changeset
|
601 cyg_interrupt *n = *p; |
| 2 | 602 |
|
151
25e238959bae
Merge from eCos master repository on 2001-02-12-23:44:24-GMT
jlarmour
parents:
149
diff
changeset
|
603 if( n == intr ) |
|
25e238959bae
Merge from eCos master repository on 2001-02-12-23:44:24-GMT
jlarmour
parents:
149
diff
changeset
|
604 { |
|
25e238959bae
Merge from eCos master repository on 2001-02-12-23:44:24-GMT
jlarmour
parents:
149
diff
changeset
|
605 *p = intr->next; |
|
25e238959bae
Merge from eCos master repository on 2001-02-12-23:44:24-GMT
jlarmour
parents:
149
diff
changeset
|
606 break; |
|
25e238959bae
Merge from eCos master repository on 2001-02-12-23:44:24-GMT
jlarmour
parents:
149
diff
changeset
|
607 } |
|
25e238959bae
Merge from eCos master repository on 2001-02-12-23:44:24-GMT
jlarmour
parents:
149
diff
changeset
|
608 |
|
25e238959bae
Merge from eCos master repository on 2001-02-12-23:44:24-GMT
jlarmour
parents:
149
diff
changeset
|
609 p = &n->next; |
|
25e238959bae
Merge from eCos master repository on 2001-02-12-23:44:24-GMT
jlarmour
parents:
149
diff
changeset
|
610 } |
| 2 | 611 |
|
151
25e238959bae
Merge from eCos master repository on 2001-02-12-23:44:24-GMT
jlarmour
parents:
149
diff
changeset
|
612 // If this was the last one, detach the vector. |
| 2 | 613 |
|
151
25e238959bae
Merge from eCos master repository on 2001-02-12-23:44:24-GMT
jlarmour
parents:
149
diff
changeset
|
614 if( chain_list[index] == NULL ) |
|
25e238959bae
Merge from eCos master repository on 2001-02-12-23:44:24-GMT
jlarmour
parents:
149
diff
changeset
|
615 HAL_INTERRUPT_DETACH( intr->vector, chain_isr ); |
|
25e238959bae
Merge from eCos master repository on 2001-02-12-23:44:24-GMT
jlarmour
parents:
149
diff
changeset
|
616 } |
| 2 | 617 |
| 618 #else | |
| 619 | |
| 620 HAL_INTERRUPT_DETACH( intr->vector, intr->isr ); | |
| 621 | |
| 622 #endif | |
| 623 | |
| 624 CYG_REPORT_RETURN(); | |
| 625 } | |
| 626 | |
| 627 | |
| 628 //-------------------------------------------------------------------------- | |
| 629 // Mask delivery of an interrupt at the interrupt controller. | |
| 630 | |
| 631 externC void cyg_drv_interrupt_mask( cyg_vector_t vector ) | |
| 632 { | |
| 633 CYG_REPORT_FUNCTION(); | |
| 634 CYG_REPORT_FUNCARG1("vector=%d", vector); | |
| 635 | |
| 636 CYG_ASSERT( vector >= CYGNUM_HAL_ISR_MIN, "Invalid vector"); | |
| 637 CYG_ASSERT( vector <= CYGNUM_HAL_ISR_MAX, "Invalid vector"); | |
| 638 | |
| 639 HAL_INTERRUPT_MASK( vector ); | |
| 640 | |
| 641 CYG_REPORT_RETURN(); | |
| 642 } | |
| 643 | |
| 644 //-------------------------------------------------------------------------- | |
| 645 // Unmask delivery of an interrupt at the interrupt controller. | |
| 646 | |
| 647 externC void cyg_drv_interrupt_unmask( cyg_vector_t vector ) | |
| 648 { | |
| 649 CYG_REPORT_FUNCTION(); | |
| 650 | |
| 651 CYG_ASSERT( vector >= CYGNUM_HAL_ISR_MIN, "Invalid vector"); | |
| 652 CYG_ASSERT( vector <= CYGNUM_HAL_ISR_MAX, "Invalid vector"); | |
| 653 | |
| 654 HAL_INTERRUPT_UNMASK( vector ); | |
| 655 | |
| 656 CYG_REPORT_RETURN(); | |
| 657 } | |
| 658 | |
| 659 //-------------------------------------------------------------------------- | |
| 660 // Acknowledge an interrupt at the controller to allow another interrupt | |
| 661 // to be delivered. | |
| 662 | |
| 663 externC void cyg_drv_interrupt_acknowledge( cyg_vector_t vector ) | |
| 664 { | |
| 665 // CYG_REPORT_FUNCTION(); | |
| 666 | |
| 667 CYG_ASSERT( vector >= CYGNUM_HAL_ISR_MIN, "Invalid vector"); | |
| 668 CYG_ASSERT( vector <= CYGNUM_HAL_ISR_MAX, "Invalid vector"); | |
| 669 | |
| 670 HAL_INTERRUPT_ACKNOWLEDGE( vector ); | |
| 671 | |
| 672 // CYG_REPORT_RETURN(); | |
| 673 } | |
| 674 | |
| 675 //-------------------------------------------------------------------------- | |
| 676 // Configure interrupt detection parameters. | |
| 677 | |
| 678 externC void cyg_drv_interrupt_configure( | |
| 679 cyg_vector_t vector, | |
| 680 cyg_bool_t level, | |
| 681 cyg_bool_t up | |
| 682 ) | |
| 683 { | |
| 684 CYG_REPORT_FUNCTION(); | |
| 685 CYG_REPORT_FUNCARG3("vector = %d, level = %d, up = %d", vector, level, | |
| 686 up); | |
| 687 | |
| 688 CYG_ASSERT( vector >= CYGNUM_HAL_ISR_MIN, "Invalid vector"); | |
| 689 CYG_ASSERT( vector <= CYGNUM_HAL_ISR_MAX, "Invalid vector"); | |
| 690 | |
| 691 HAL_INTERRUPT_CONFIGURE( vector, level, up ); | |
| 692 | |
| 693 CYG_REPORT_RETURN(); | |
| 694 } | |
| 695 | |
| 696 //-------------------------------------------------------------------------- | |
| 697 // Configure interrupt priority level. | |
| 698 | |
| 699 externC void cyg_drv_interrupt_level( cyg_vector_t vector, cyg_priority_t level ) | |
| 700 { | |
| 701 CYG_REPORT_FUNCTION(); | |
| 702 CYG_REPORT_FUNCARG2("vector = %d, level = %d", vector, level); | |
| 703 | |
| 704 CYG_ASSERT( vector >= CYGNUM_HAL_ISR_MIN, "Invalid vector"); | |
| 705 CYG_ASSERT( vector <= CYGNUM_HAL_ISR_MAX, "Invalid vector"); | |
| 706 | |
| 707 HAL_INTERRUPT_SET_LEVEL( vector, level ); | |
| 708 | |
| 709 CYG_REPORT_RETURN(); | |
| 710 } | |
| 711 | |
| 712 | |
| 713 // ------------------------------------------------------------------------- | |
| 714 // Exception delivery function called from the HAL as a result of a | |
| 715 // hardware exception being raised. | |
| 716 | |
| 717 externC void cyg_hal_deliver_exception( CYG_WORD code, CYG_ADDRWORD data ) | |
| 718 { | |
| 719 CYG_FAIL(" !!! Exception !!! "); | |
| 720 } | |
| 721 | |
| 722 | |
| 723 #endif | |
| 724 | |
| 725 //-------------------------------------------------------------------------- | |
| 726 // EOF drv_api.c |