1
  
2
  
3
  
4
  
5
  
6
  
7
  
8
  
9
  
10
  
11
  
12
  
13
  
14
  
15
  
16
  
17
  
18
  
19
  
20
  
21
  
22
  
23
  
24
  
25
  
26
  
27
  
28
  
29
  
30
  
31
  
32
  
33
  
34
  
35
  
36
  
37
  
38
  
39
  
40
  
41
  
42
  
43
  
44
  
45
  
46
  
47
  
48
  
49
  
50
  
51
  
52
  
53
  
54
  
55
  
56
  
57
  
58
  
59
  
60
  
61
  
62
  
63
  
64
  
65
  
66
  
67
  
68
  
69
  
70
  
71
  
72
  
73
  
74
  
75
  
76
  
77
  
78
  
79
  
80
  
81
  
82
  
83
  
84
  
85
  
86
  
87
  
88
  
89
  
90
  
91
  
92
  
93
  
94
  
95
  
96
  
97
  
98
  
99
  
100
  
101
  
/*\ 
||| This file a part of uLPC, and is copyright by Fredrik Hubinette 
||| uLPC is distributed as GPL (General Public License) 
||| See the files COPYING and DISCLAIMER for more information. 
\*/ 
#include "macros.h" 
#include "callback.h" 
 
struct callback 
{ 
  struct callback *next; 
  callback_func call; 
  callback_func free_func; 
  void *arg; 
}; 
 
struct callback *first_callback =0; 
struct callback *free_callbacks =0; 
 
#define CALLBACK_CHUNK 128 
 
struct callback_block { 
  struct callback_block *next; 
  struct callback callbacks[CALLBACK_CHUNK]; 
}; 
 
static struct callback *get_free_callback() 
{ 
  struct callback *tmp; 
  if(!(tmp=free_callbacks)) 
  { 
    int e; 
    struct callback_block *tmp2; 
    tmp2=ALLOC_STRUCT(callback_block); 
 
    for(e=0;e<(int)sizeof(CALLBACK_CHUNK);e++) 
    { 
      tmp2->callbacks[e].next=tmp; 
      tmp=tmp2->callbacks+e; 
    } 
  } 
  free_callbacks=tmp->next; 
  return tmp; 
} 
 
void call_callback(struct callback **ptr, void *arg) 
{ 
  struct callback *l; 
  while(l=*ptr) 
  { 
    if(l->call) l->call(l,l->arg, arg); 
 
    if(!l->call) 
    { 
      *ptr=l->next; 
      l->next=free_callbacks; 
      free_callbacks=l; 
    }else{ 
      ptr=& l->next; 
    } 
  } 
} 
 
struct callback *add_to_callback(struct callback **ptr, 
                                 callback_func call, 
                                 void *arg, 
                                 callback_func free_func) 
{ 
  struct callback *l; 
  l=get_free_callback(); 
  l->call=call; 
  l->arg=arg; 
 
  l->next=*ptr; 
  *ptr=l; 
 
  return l; 
} 
 
/* It is not actually freed until next time this callback is called 
 */ 
void *remove_callback(struct callback *l) 
{ 
  l->call=0; 
  return l->arg; 
} 
 
void free_callback(struct callback **ptr) 
{ 
  struct callback *l; 
  while(l=*ptr) 
  { 
    if(l->arg && l->free_func) 
      l->free_func(l, l->arg, 0); 
    *ptr=l->next; 
    l->next=free_callbacks; 
    free_callbacks=l; 
  } 
}