@@ -123,15 +123,15 @@ u32_t sys_now(void) {
123
123
*---------------------------------------------------------------------------*/
124
124
err_t sys_mbox_new (sys_mbox_t * mbox , int queue_sz ) {
125
125
if (queue_sz > MB_SIZE )
126
- error ( "sys_mbox_new size error\n" );
126
+ MBED_ERROR1 ( MBED_MAKE_ERROR ( MBED_MODULE_NETWORK_STACK , MBED_ERROR_CODE_INVALID_SIZE ), "sys_mbox_new size error\n" , queue_sz );
127
127
128
128
memset (mbox , 0 , sizeof (* mbox ));
129
129
130
130
mbox -> attr .cb_mem = & mbox -> data ;
131
131
mbox -> attr .cb_size = sizeof (mbox -> data );
132
132
mbox -> id = osEventFlagsNew (& mbox -> attr );
133
133
if (mbox -> id == NULL )
134
- error ( "sys_mbox_new create error\n" );
134
+ MBED_ERROR1 ( MBED_MAKE_ERROR ( MBED_MODULE_NETWORK_STACK , MBED_ERROR_CODE_FAILED_OPERATION ), "sys_mbox_new create error\n" , ( u32_t ) mbox );
135
135
136
136
osEventFlagsSet (mbox -> id , SYS_MBOX_POST_EVENT );
137
137
@@ -150,7 +150,7 @@ err_t sys_mbox_new(sys_mbox_t *mbox, int queue_sz) {
150
150
*---------------------------------------------------------------------------*/
151
151
void sys_mbox_free (sys_mbox_t * mbox ) {
152
152
if (mbox -> post_idx != mbox -> fetch_idx )
153
- error ( "sys_mbox_free error\n" );
153
+ MBED_ERROR1 ( MBED_MAKE_ERROR ( MBED_MODULE_NETWORK_STACK , MBED_ERROR_CODE_INVALID_INDEX ), "sys_mbox_free error\n" , ( u32_t ) mbox -> fetch_idx );
154
154
}
155
155
156
156
/*---------------------------------------------------------------------------*
@@ -194,8 +194,10 @@ void sys_mbox_post(sys_mbox_t *mbox, void *msg) {
194
194
err_t sys_mbox_trypost (sys_mbox_t * mbox , void * msg ) {
195
195
uint32_t flags = osEventFlagsWait (mbox -> id , SYS_MBOX_POST_EVENT ,
196
196
osFlagsWaitAny | osFlagsNoClear , 0 );
197
- if ((flags & osFlagsError ) || !(flags & SYS_MBOX_POST_EVENT ))
197
+ if ((flags & osFlagsError ) || !(flags & SYS_MBOX_POST_EVENT )) {
198
+ MBED_WARNING1 (MBED_MAKE_ERROR (MBED_MODULE_NETWORK_STACK , MBED_ERROR_CODE_FAILED_OPERATION ), "sys_mbox_trypost error\n" , flags );
198
199
return ERR_MEM ;
200
+ }
199
201
200
202
int state = osKernelLock ();
201
203
@@ -239,8 +241,10 @@ u32_t sys_arch_mbox_fetch(sys_mbox_t *mbox, void **msg, u32_t timeout) {
239
241
uint32_t start = osKernelGetTickCount ();
240
242
uint32_t flags = osEventFlagsWait (mbox -> id , SYS_MBOX_FETCH_EVENT ,
241
243
osFlagsWaitAny | osFlagsNoClear , (timeout ? timeout : osWaitForever ));
242
- if ((flags & osFlagsError ) || !(flags & SYS_MBOX_FETCH_EVENT ))
244
+ if ((flags & osFlagsError ) || !(flags & SYS_MBOX_FETCH_EVENT )) {
245
+ MBED_WARNING1 (MBED_MAKE_ERROR (MBED_MODULE_NETWORK_STACK , MBED_ERROR_CODE_TIME_OUT ), "sys_arch_mbox_fetch time-out\n" , flags );
243
246
return SYS_ARCH_TIMEOUT ;
247
+ }
244
248
245
249
int state = osKernelLock ();
246
250
@@ -273,8 +277,10 @@ u32_t sys_arch_mbox_fetch(sys_mbox_t *mbox, void **msg, u32_t timeout) {
273
277
u32_t sys_arch_mbox_tryfetch (sys_mbox_t * mbox , void * * msg ) {
274
278
uint32_t flags = osEventFlagsWait (mbox -> id , SYS_MBOX_FETCH_EVENT ,
275
279
osFlagsWaitAny | osFlagsNoClear , 0 );
276
- if ((flags & osFlagsError ) || !(flags & SYS_MBOX_FETCH_EVENT ))
280
+ if ((flags & osFlagsError ) || !(flags & SYS_MBOX_FETCH_EVENT )) {
281
+ MBED_WARNING1 (MBED_MAKE_ERROR (MBED_MODULE_NETWORK_STACK , MBED_ERROR_CODE_FAILED_OPERATION ), "sys_arch_mbox_tryfetch empty\n" , flags );
277
282
return SYS_MBOX_EMPTY ;
283
+ }
278
284
279
285
int state = osKernelLock ();
280
286
@@ -309,7 +315,7 @@ err_t sys_sem_new(sys_sem_t *sem, u8_t count) {
309
315
sem -> attr .cb_size = sizeof (sem -> data );
310
316
sem -> id = osSemaphoreNew (UINT16_MAX , count , & sem -> attr );
311
317
if (sem -> id == NULL )
312
- error ( "sys_sem_new create error\n" );
318
+ MBED_ERROR1 ( MBED_MAKE_ERROR ( MBED_MODULE_NETWORK_STACK , MBED_ERROR_CODE_FAILED_OPERATION ), "sys_sem_new create error\n" , ( u32_t ) sem );
313
319
314
320
return ERR_OK ;
315
321
}
@@ -340,8 +346,10 @@ err_t sys_sem_new(sys_sem_t *sem, u8_t count) {
340
346
u32_t sys_arch_sem_wait (sys_sem_t * sem , u32_t timeout ) {
341
347
u32_t start = osKernelGetTickCount ();
342
348
343
- if (osSemaphoreAcquire (sem -> id , (timeout != 0 )?(timeout ):(osWaitForever )) != osOK )
349
+ if (osSemaphoreAcquire (sem -> id , (timeout != 0 )?(timeout ):(osWaitForever )) != osOK ) {
350
+ MBED_WARNING1 (MBED_MAKE_ERROR (MBED_MODULE_NETWORK_STACK , MBED_ERROR_CODE_TIME_OUT ), "sys_arch_sem_wait time out\n" , (u32_t )sem );
344
351
return SYS_ARCH_TIMEOUT ;
352
+ }
345
353
346
354
return osKernelGetTickCount () - start ;
347
355
}
@@ -356,7 +364,7 @@ u32_t sys_arch_sem_wait(sys_sem_t *sem, u32_t timeout) {
356
364
*---------------------------------------------------------------------------*/
357
365
void sys_sem_signal (sys_sem_t * data ) {
358
366
if (osSemaphoreRelease (data -> id ) != osOK )
359
- mbed_die (); /* Can be called by ISR do not use printf */
367
+ MBED_ERROR1 ( MBED_MAKE_ERROR ( MBED_MODULE_NETWORK_STACK , MBED_ERROR_CODE_SEMAPHORE_UNLOCK_FAILED ), "sys_sem_signal error\n" , ( u32_t ) data -> id );
360
368
}
361
369
362
370
/*---------------------------------------------------------------------------*
@@ -378,8 +386,10 @@ err_t sys_mutex_new(sys_mutex_t *mutex) {
378
386
mutex -> attr .cb_mem = & mutex -> data ;
379
387
mutex -> attr .cb_size = sizeof (mutex -> data );
380
388
mutex -> id = osMutexNew (& mutex -> attr );
381
- if (mutex -> id == NULL )
389
+ if (mutex -> id == NULL ) {
390
+ MBED_WARNING1 (MBED_MAKE_ERROR (MBED_MODULE_NETWORK_STACK , MBED_ERROR_CODE_FAILED_OPERATION ), "sys_mutex_new error\n" , (u32_t )mutex );
382
391
return ERR_MEM ;
392
+ }
383
393
384
394
return ERR_OK ;
385
395
}
@@ -388,14 +398,14 @@ err_t sys_mutex_new(sys_mutex_t *mutex) {
388
398
* @param mutex the mutex to lock */
389
399
void sys_mutex_lock (sys_mutex_t * mutex ) {
390
400
if (osMutexAcquire (mutex -> id , osWaitForever ) != osOK )
391
- error ( "sys_mutex_lock error\n" );
401
+ MBED_ERROR1 ( MBED_MAKE_ERROR ( MBED_MODULE_NETWORK_STACK , MBED_ERROR_CODE_MUTEX_LOCK_FAILED ), "sys_mutex_lock error\n" , ( u32_t ) mutex );
392
402
}
393
403
394
404
/** Unlock a mutex
395
405
* @param mutex the mutex to unlock */
396
406
void sys_mutex_unlock (sys_mutex_t * mutex ) {
397
407
if (osMutexRelease (mutex -> id ) != osOK )
398
- error ( "sys_mutex_unlock error\n" );
408
+ MBED_ERROR1 ( MBED_MAKE_ERROR ( MBED_MODULE_NETWORK_STACK , MBED_ERROR_CODE_MUTEX_UNLOCK_FAILED ), "sys_mutex_unlock error\n" , ( u32_t ) mutex );
399
409
}
400
410
401
411
/** Delete a mutex
@@ -418,7 +428,7 @@ void sys_init(void) {
418
428
lwip_sys_mutex_attr .cb_size = sizeof (lwip_sys_mutex_data );
419
429
lwip_sys_mutex = osMutexNew (& lwip_sys_mutex_attr );
420
430
if (lwip_sys_mutex == NULL )
421
- error ( "sys_init error\n" );
431
+ MBED_ERROR ( MBED_MAKE_ERROR ( MBED_MODULE_NETWORK_STACK , MBED_ERROR_CODE_INITIALIZATION_FAILED ), "sys_init error, mutex initialization failed \n" );
422
432
}
423
433
424
434
/*---------------------------------------------------------------------------*
@@ -452,7 +462,7 @@ u32_t sys_jiffies(void) {
452
462
*---------------------------------------------------------------------------*/
453
463
sys_prot_t sys_arch_protect (void ) {
454
464
if (osMutexAcquire (lwip_sys_mutex , osWaitForever ) != osOK )
455
- error ( "sys_arch_protect error\n" );
465
+ MBED_ERROR ( MBED_MAKE_ERROR ( MBED_MODULE_NETWORK_STACK , MBED_ERROR_CODE_MUTEX_LOCK_FAILED ), "sys_arch_protect error\n" );
456
466
return (sys_prot_t ) 1 ;
457
467
}
458
468
@@ -469,7 +479,7 @@ sys_prot_t sys_arch_protect(void) {
469
479
*---------------------------------------------------------------------------*/
470
480
void sys_arch_unprotect (sys_prot_t p ) {
471
481
if (osMutexRelease (lwip_sys_mutex ) != osOK )
472
- error ( "sys_arch_unprotect error\n" );
482
+ MBED_ERROR ( MBED_MAKE_ERROR ( MBED_MODULE_NETWORK_STACK , MBED_ERROR_CODE_MUTEX_UNLOCK_FAILED ), "sys_arch_unprotect error\n" );
473
483
}
474
484
475
485
u32_t sys_now (void ) {
@@ -524,7 +534,7 @@ static sys_thread_data_t thread_pool[SYS_THREAD_POOL_N];
524
534
LWIP_DEBUGF (SYS_DEBUG , ("New Thread: %s\n" , pcName ));
525
535
526
536
if (thread_pool_index >= SYS_THREAD_POOL_N )
527
- error ( "sys_thread_new number error\n" );
537
+ MBED_ERROR1 ( MBED_MAKE_ERROR ( MBED_MODULE_NETWORK_STACK , MBED_ERROR_CODE_THREAD_CREATE_FAILED ), "sys_thread_new number error\n" , thread_pool_index );
528
538
sys_thread_t t = (sys_thread_t )& thread_pool [thread_pool_index ];
529
539
thread_pool_index ++ ;
530
540
@@ -537,11 +547,11 @@ static sys_thread_data_t thread_pool[SYS_THREAD_POOL_N];
537
547
t -> attr .stack_mem = malloc (stacksize );
538
548
t -> attr .tz_module = MBED_TZ_DEFAULT_ACCESS ;
539
549
if (t -> attr .stack_mem == NULL ) {
540
- error ( "Error allocating the stack memory" );
550
+ MBED_ERROR1 ( MBED_MAKE_ERROR ( MBED_MODULE_NETWORK_STACK , MBED_ERROR_CODE_OUT_OF_MEMORY ), "unable to allocate thread stack\n" , stacksize );
541
551
}
542
552
t -> id = osThreadNew ((osThreadFunc_t )thread , arg , & t -> attr );
543
553
if (t -> id == NULL )
544
- error ( "sys_thread_new create error\n" );
554
+ MBED_ERROR ( MBED_MAKE_ERROR ( MBED_MODULE_NETWORK_STACK , MBED_ERROR_CODE_THREAD_CREATE_FAILED ), "sys_thread_new create error\n" );
545
555
546
556
return t ;
547
557
}
0 commit comments