author | edouard |
Thu, 17 Feb 2011 15:59:56 +0100 | |
changeset 572 | c965548cb6f7 |
parent 568 | 20a223828a06 |
child 580 | 9dd978e6537c |
permissions | -rw-r--r-- |
280
f2ef79f3dba0
Added native (not a plugin) asynchronous python eval function block - Beta. Code cleanup in C code templates.
etisserant
parents:
245
diff
changeset
|
1 |
/** |
f2ef79f3dba0
Added native (not a plugin) asynchronous python eval function block - Beta. Code cleanup in C code templates.
etisserant
parents:
245
diff
changeset
|
2 |
* Linux specific code |
329 | 3 |
**/ |
280
f2ef79f3dba0
Added native (not a plugin) asynchronous python eval function block - Beta. Code cleanup in C code templates.
etisserant
parents:
245
diff
changeset
|
4 |
|
205 | 5 |
#include <stdio.h> |
6 |
#include <string.h> |
|
7 |
#include <time.h> |
|
8 |
#include <signal.h> |
|
9 |
#include <stdlib.h> |
|
329 | 10 |
#include <pthread.h> |
568 | 11 |
#include <locale.h> |
205 | 12 |
|
280
f2ef79f3dba0
Added native (not a plugin) asynchronous python eval function block - Beta. Code cleanup in C code templates.
etisserant
parents:
245
diff
changeset
|
13 |
/* provided by POUS.C */ |
518
8e61b0066859
Fixed confusion about __common_ticktime type, redesigned LPC PLC timer support
edouard
parents:
485
diff
changeset
|
14 |
extern unsigned long long common_ticktime__; |
280
f2ef79f3dba0
Added native (not a plugin) asynchronous python eval function block - Beta. Code cleanup in C code templates.
etisserant
parents:
245
diff
changeset
|
15 |
|
236 | 16 |
long AtomicCompareExchange(long* atomicvar,long compared, long exchange) |
205 | 17 |
{ |
18 |
return __sync_val_compare_and_swap(atomicvar, compared, exchange); |
|
19 |
} |
|
20 |
||
21 |
void PLC_GetTime(IEC_TIME *CURRENT_TIME) |
|
22 |
{ |
|
23 |
clock_gettime(CLOCK_REALTIME, CURRENT_TIME); |
|
24 |
} |
|
25 |
||
26 |
void PLC_timer_notify(sigval_t val) |
|
27 |
{ |
|
28 |
PLC_GetTime(&__CURRENT_TIME); |
|
29 |
__run(); |
|
30 |
} |
|
31 |
||
32 |
timer_t PLC_timer; |
|
33 |
||
518
8e61b0066859
Fixed confusion about __common_ticktime type, redesigned LPC PLC timer support
edouard
parents:
485
diff
changeset
|
34 |
void PLC_SetTimer(unsigned long long next, unsigned long long period) |
205 | 35 |
{ |
36 |
struct itimerspec timerValues; |
|
37 |
/* |
|
38 |
printf("SetTimer(%lld,%lld)\n",next, period); |
|
39 |
*/ |
|
40 |
memset (&timerValues, 0, sizeof (struct itimerspec)); |
|
41 |
{ |
|
42 |
#ifdef __lldiv_t_defined |
|
43 |
lldiv_t nxt_div = lldiv(next, 1000000000); |
|
44 |
lldiv_t period_div = lldiv(period, 1000000000); |
|
45 |
timerValues.it_value.tv_sec = nxt_div.quot; |
|
46 |
timerValues.it_value.tv_nsec = nxt_div.rem; |
|
47 |
timerValues.it_interval.tv_sec = period_div.quot; |
|
48 |
timerValues.it_interval.tv_nsec = period_div.rem; |
|
49 |
#else |
|
50 |
timerValues.it_value.tv_sec = next / 1000000000; |
|
51 |
timerValues.it_value.tv_nsec = next % 1000000000; |
|
52 |
timerValues.it_interval.tv_sec = period / 1000000000; |
|
53 |
timerValues.it_interval.tv_nsec = period % 1000000000; |
|
54 |
#endif |
|
329 | 55 |
} |
205 | 56 |
timer_settime (PLC_timer, 0, &timerValues, NULL); |
57 |
} |
|
58 |
// |
|
59 |
void catch_signal(int sig) |
|
60 |
{ |
|
61 |
// signal(SIGTERM, catch_signal); |
|
62 |
signal(SIGINT, catch_signal); |
|
63 |
printf("Got Signal %d\n",sig); |
|
64 |
exit(0); |
|
65 |
} |
|
66 |
||
239
112b4bc523b3
Fixed bad IPC choice for debugger/PLC/control thread collaboration
etisserant
parents:
236
diff
changeset
|
67 |
|
397
6a7ff66a811d
Adding support for forcing tick count to return to zero as the same time than all tasks firing are synchronized
laurent
parents:
386
diff
changeset
|
68 |
static unsigned long __debug_tick; |
239
112b4bc523b3
Fixed bad IPC choice for debugger/PLC/control thread collaboration
etisserant
parents:
236
diff
changeset
|
69 |
|
280
f2ef79f3dba0
Added native (not a plugin) asynchronous python eval function block - Beta. Code cleanup in C code templates.
etisserant
parents:
245
diff
changeset
|
70 |
static pthread_mutex_t python_wait_mutex = PTHREAD_MUTEX_INITIALIZER; |
f2ef79f3dba0
Added native (not a plugin) asynchronous python eval function block - Beta. Code cleanup in C code templates.
etisserant
parents:
245
diff
changeset
|
71 |
static pthread_mutex_t python_mutex = PTHREAD_MUTEX_INITIALIZER; |
f2ef79f3dba0
Added native (not a plugin) asynchronous python eval function block - Beta. Code cleanup in C code templates.
etisserant
parents:
245
diff
changeset
|
72 |
static pthread_mutex_t debug_wait_mutex = PTHREAD_MUTEX_INITIALIZER; |
239
112b4bc523b3
Fixed bad IPC choice for debugger/PLC/control thread collaboration
etisserant
parents:
236
diff
changeset
|
73 |
static pthread_mutex_t debug_mutex = PTHREAD_MUTEX_INITIALIZER; |
112b4bc523b3
Fixed bad IPC choice for debugger/PLC/control thread collaboration
etisserant
parents:
236
diff
changeset
|
74 |
|
280
f2ef79f3dba0
Added native (not a plugin) asynchronous python eval function block - Beta. Code cleanup in C code templates.
etisserant
parents:
245
diff
changeset
|
75 |
#define maxval(a,b) ((a>b)?a:b) |
205 | 76 |
int startPLC(int argc,char **argv) |
77 |
{ |
|
78 |
struct sigevent sigev; |
|
568 | 79 |
setlocale(LC_NUMERIC, "C"); |
397
6a7ff66a811d
Adding support for forcing tick count to return to zero as the same time than all tasks firing are synchronized
laurent
parents:
386
diff
changeset
|
80 |
/* Define Ttick to 1ms if common_ticktime not defined */ |
6a7ff66a811d
Adding support for forcing tick count to return to zero as the same time than all tasks firing are synchronized
laurent
parents:
386
diff
changeset
|
81 |
Ttick = common_ticktime__?common_ticktime__:1000000; |
329 | 82 |
|
205 | 83 |
memset (&sigev, 0, sizeof (struct sigevent)); |
84 |
sigev.sigev_value.sival_int = 0; |
|
85 |
sigev.sigev_notify = SIGEV_THREAD; |
|
86 |
sigev.sigev_notify_attributes = NULL; |
|
87 |
sigev.sigev_notify_function = PLC_timer_notify; |
|
88 |
||
333 | 89 |
pthread_mutex_init(&debug_wait_mutex, NULL); |
462
274e83a5534e
Now debug is not a button anymore
Edouard TISSERANT <edouard.tisserant@gmail.com>
parents:
446
diff
changeset
|
90 |
pthread_mutex_init(&debug_mutex, NULL); |
333 | 91 |
pthread_mutex_init(&python_wait_mutex, NULL); |
462
274e83a5534e
Now debug is not a button anymore
Edouard TISSERANT <edouard.tisserant@gmail.com>
parents:
446
diff
changeset
|
92 |
pthread_mutex_init(&python_mutex, NULL); |
329 | 93 |
|
280
f2ef79f3dba0
Added native (not a plugin) asynchronous python eval function block - Beta. Code cleanup in C code templates.
etisserant
parents:
245
diff
changeset
|
94 |
pthread_mutex_lock(&debug_wait_mutex); |
f2ef79f3dba0
Added native (not a plugin) asynchronous python eval function block - Beta. Code cleanup in C code templates.
etisserant
parents:
245
diff
changeset
|
95 |
pthread_mutex_lock(&python_wait_mutex); |
239
112b4bc523b3
Fixed bad IPC choice for debugger/PLC/control thread collaboration
etisserant
parents:
236
diff
changeset
|
96 |
|
205 | 97 |
timer_create (CLOCK_REALTIME, &sigev, &PLC_timer); |
98 |
if( __init(argc,argv) == 0 ){ |
|
99 |
PLC_SetTimer(Ttick,Ttick); |
|
329 | 100 |
|
205 | 101 |
/* install signal handler for manual break */ |
102 |
signal(SIGINT, catch_signal); |
|
103 |
}else{ |
|
104 |
return 1; |
|
105 |
} |
|
106 |
return 0; |
|
107 |
} |
|
108 |
||
239
112b4bc523b3
Fixed bad IPC choice for debugger/PLC/control thread collaboration
etisserant
parents:
236
diff
changeset
|
109 |
int TryEnterDebugSection(void) |
112b4bc523b3
Fixed bad IPC choice for debugger/PLC/control thread collaboration
etisserant
parents:
236
diff
changeset
|
110 |
{ |
462
274e83a5534e
Now debug is not a button anymore
Edouard TISSERANT <edouard.tisserant@gmail.com>
parents:
446
diff
changeset
|
111 |
if (pthread_mutex_trylock(&debug_mutex) == 0){ |
274e83a5534e
Now debug is not a button anymore
Edouard TISSERANT <edouard.tisserant@gmail.com>
parents:
446
diff
changeset
|
112 |
/* Only enter if debug active */ |
274e83a5534e
Now debug is not a button anymore
Edouard TISSERANT <edouard.tisserant@gmail.com>
parents:
446
diff
changeset
|
113 |
if(__DEBUG){ |
274e83a5534e
Now debug is not a button anymore
Edouard TISSERANT <edouard.tisserant@gmail.com>
parents:
446
diff
changeset
|
114 |
return 1; |
274e83a5534e
Now debug is not a button anymore
Edouard TISSERANT <edouard.tisserant@gmail.com>
parents:
446
diff
changeset
|
115 |
} |
483
bc26c42d2eec
fixed greg's crap in win32, enhanced debug stability, implemented preliminary retain
edouard
parents:
462
diff
changeset
|
116 |
pthread_mutex_unlock(&debug_mutex); |
462
274e83a5534e
Now debug is not a button anymore
Edouard TISSERANT <edouard.tisserant@gmail.com>
parents:
446
diff
changeset
|
117 |
} |
274e83a5534e
Now debug is not a button anymore
Edouard TISSERANT <edouard.tisserant@gmail.com>
parents:
446
diff
changeset
|
118 |
return 0; |
239
112b4bc523b3
Fixed bad IPC choice for debugger/PLC/control thread collaboration
etisserant
parents:
236
diff
changeset
|
119 |
} |
235 | 120 |
|
239
112b4bc523b3
Fixed bad IPC choice for debugger/PLC/control thread collaboration
etisserant
parents:
236
diff
changeset
|
121 |
void LeaveDebugSection(void) |
235 | 122 |
{ |
239
112b4bc523b3
Fixed bad IPC choice for debugger/PLC/control thread collaboration
etisserant
parents:
236
diff
changeset
|
123 |
pthread_mutex_unlock(&debug_mutex); |
235 | 124 |
} |
125 |
||
205 | 126 |
int stopPLC() |
127 |
{ |
|
128 |
/* Stop the PLC */ |
|
129 |
PLC_SetTimer(0,0); |
|
130 |
timer_delete (PLC_timer); |
|
131 |
__cleanup(); |
|
329 | 132 |
pthread_mutex_destroy(&debug_wait_mutex); |
483
bc26c42d2eec
fixed greg's crap in win32, enhanced debug stability, implemented preliminary retain
edouard
parents:
462
diff
changeset
|
133 |
pthread_mutex_destroy(&debug_mutex); |
329 | 134 |
pthread_mutex_destroy(&python_wait_mutex); |
483
bc26c42d2eec
fixed greg's crap in win32, enhanced debug stability, implemented preliminary retain
edouard
parents:
462
diff
changeset
|
135 |
pthread_mutex_destroy(&python_mutex); |
386 | 136 |
return 0; |
205 | 137 |
} |
138 |
||
397
6a7ff66a811d
Adding support for forcing tick count to return to zero as the same time than all tasks firing are synchronized
laurent
parents:
386
diff
changeset
|
139 |
extern unsigned long __tick; |
446
1edde533db19
Some cleanup in PLC status - removed that \"Starting\" state ...
ed
parents:
397
diff
changeset
|
140 |
|
1edde533db19
Some cleanup in PLC status - removed that \"Starting\" state ...
ed
parents:
397
diff
changeset
|
141 |
int WaitDebugData(unsigned long *tick) |
205 | 142 |
{ |
446
1edde533db19
Some cleanup in PLC status - removed that \"Starting\" state ...
ed
parents:
397
diff
changeset
|
143 |
*tick = __debug_tick; |
205 | 144 |
/* Wait signal from PLC thread */ |
446
1edde533db19
Some cleanup in PLC status - removed that \"Starting\" state ...
ed
parents:
397
diff
changeset
|
145 |
return pthread_mutex_lock(&debug_wait_mutex); |
205 | 146 |
} |
329 | 147 |
|
205 | 148 |
/* Called by PLC thread when debug_publish finished |
149 |
* This is supposed to unlock debugger thread in WaitDebugData*/ |
|
150 |
void InitiateDebugTransfer() |
|
151 |
{ |
|
239
112b4bc523b3
Fixed bad IPC choice for debugger/PLC/control thread collaboration
etisserant
parents:
236
diff
changeset
|
152 |
/* remember tick */ |
227
48c13b84505c
- Some improovements in debug data feedback data
etisserant
parents:
205
diff
changeset
|
153 |
__debug_tick = __tick; |
239
112b4bc523b3
Fixed bad IPC choice for debugger/PLC/control thread collaboration
etisserant
parents:
236
diff
changeset
|
154 |
/* signal debugger thread it can read data */ |
280
f2ef79f3dba0
Added native (not a plugin) asynchronous python eval function block - Beta. Code cleanup in C code templates.
etisserant
parents:
245
diff
changeset
|
155 |
pthread_mutex_unlock(&debug_wait_mutex); |
205 | 156 |
} |
239
112b4bc523b3
Fixed bad IPC choice for debugger/PLC/control thread collaboration
etisserant
parents:
236
diff
changeset
|
157 |
|
462
274e83a5534e
Now debug is not a button anymore
Edouard TISSERANT <edouard.tisserant@gmail.com>
parents:
446
diff
changeset
|
158 |
void suspendDebug(int disable) |
274e83a5534e
Now debug is not a button anymore
Edouard TISSERANT <edouard.tisserant@gmail.com>
parents:
446
diff
changeset
|
159 |
{ |
239
112b4bc523b3
Fixed bad IPC choice for debugger/PLC/control thread collaboration
etisserant
parents:
236
diff
changeset
|
160 |
/* Prevent PLC to enter debug code */ |
112b4bc523b3
Fixed bad IPC choice for debugger/PLC/control thread collaboration
etisserant
parents:
236
diff
changeset
|
161 |
pthread_mutex_lock(&debug_mutex); |
462
274e83a5534e
Now debug is not a button anymore
Edouard TISSERANT <edouard.tisserant@gmail.com>
parents:
446
diff
changeset
|
162 |
/*__DEBUG is protected by this mutex */ |
274e83a5534e
Now debug is not a button anymore
Edouard TISSERANT <edouard.tisserant@gmail.com>
parents:
446
diff
changeset
|
163 |
__DEBUG = !disable; |
485 | 164 |
if (disable) |
165 |
pthread_mutex_unlock(&debug_mutex); |
|
239
112b4bc523b3
Fixed bad IPC choice for debugger/PLC/control thread collaboration
etisserant
parents:
236
diff
changeset
|
166 |
} |
112b4bc523b3
Fixed bad IPC choice for debugger/PLC/control thread collaboration
etisserant
parents:
236
diff
changeset
|
167 |
|
280
f2ef79f3dba0
Added native (not a plugin) asynchronous python eval function block - Beta. Code cleanup in C code templates.
etisserant
parents:
245
diff
changeset
|
168 |
void resumeDebug(void) |
239
112b4bc523b3
Fixed bad IPC choice for debugger/PLC/control thread collaboration
etisserant
parents:
236
diff
changeset
|
169 |
{ |
290
3bd617ae7a05
Local Runtime (LOCAL://) now launched "on demand"
etisserant
parents:
280
diff
changeset
|
170 |
__DEBUG = 1; |
239
112b4bc523b3
Fixed bad IPC choice for debugger/PLC/control thread collaboration
etisserant
parents:
236
diff
changeset
|
171 |
/* Let PLC enter debug code */ |
112b4bc523b3
Fixed bad IPC choice for debugger/PLC/control thread collaboration
etisserant
parents:
236
diff
changeset
|
172 |
pthread_mutex_unlock(&debug_mutex); |
112b4bc523b3
Fixed bad IPC choice for debugger/PLC/control thread collaboration
etisserant
parents:
236
diff
changeset
|
173 |
} |
112b4bc523b3
Fixed bad IPC choice for debugger/PLC/control thread collaboration
etisserant
parents:
236
diff
changeset
|
174 |
|
280
f2ef79f3dba0
Added native (not a plugin) asynchronous python eval function block - Beta. Code cleanup in C code templates.
etisserant
parents:
245
diff
changeset
|
175 |
/* from plc_python.c */ |
f2ef79f3dba0
Added native (not a plugin) asynchronous python eval function block - Beta. Code cleanup in C code templates.
etisserant
parents:
245
diff
changeset
|
176 |
int WaitPythonCommands(void) |
f2ef79f3dba0
Added native (not a plugin) asynchronous python eval function block - Beta. Code cleanup in C code templates.
etisserant
parents:
245
diff
changeset
|
177 |
{ |
f2ef79f3dba0
Added native (not a plugin) asynchronous python eval function block - Beta. Code cleanup in C code templates.
etisserant
parents:
245
diff
changeset
|
178 |
/* Wait signal from PLC thread */ |
329 | 179 |
return pthread_mutex_lock(&python_wait_mutex); |
280
f2ef79f3dba0
Added native (not a plugin) asynchronous python eval function block - Beta. Code cleanup in C code templates.
etisserant
parents:
245
diff
changeset
|
180 |
} |
329 | 181 |
|
280
f2ef79f3dba0
Added native (not a plugin) asynchronous python eval function block - Beta. Code cleanup in C code templates.
etisserant
parents:
245
diff
changeset
|
182 |
/* Called by PLC thread on each new python command*/ |
f2ef79f3dba0
Added native (not a plugin) asynchronous python eval function block - Beta. Code cleanup in C code templates.
etisserant
parents:
245
diff
changeset
|
183 |
void UnBlockPythonCommands(void) |
f2ef79f3dba0
Added native (not a plugin) asynchronous python eval function block - Beta. Code cleanup in C code templates.
etisserant
parents:
245
diff
changeset
|
184 |
{ |
f2ef79f3dba0
Added native (not a plugin) asynchronous python eval function block - Beta. Code cleanup in C code templates.
etisserant
parents:
245
diff
changeset
|
185 |
/* signal debugger thread it can read data */ |
f2ef79f3dba0
Added native (not a plugin) asynchronous python eval function block - Beta. Code cleanup in C code templates.
etisserant
parents:
245
diff
changeset
|
186 |
pthread_mutex_unlock(&python_wait_mutex); |
f2ef79f3dba0
Added native (not a plugin) asynchronous python eval function block - Beta. Code cleanup in C code templates.
etisserant
parents:
245
diff
changeset
|
187 |
} |
f2ef79f3dba0
Added native (not a plugin) asynchronous python eval function block - Beta. Code cleanup in C code templates.
etisserant
parents:
245
diff
changeset
|
188 |
|
f2ef79f3dba0
Added native (not a plugin) asynchronous python eval function block - Beta. Code cleanup in C code templates.
etisserant
parents:
245
diff
changeset
|
189 |
int TryLockPython(void) |
f2ef79f3dba0
Added native (not a plugin) asynchronous python eval function block - Beta. Code cleanup in C code templates.
etisserant
parents:
245
diff
changeset
|
190 |
{ |
f2ef79f3dba0
Added native (not a plugin) asynchronous python eval function block - Beta. Code cleanup in C code templates.
etisserant
parents:
245
diff
changeset
|
191 |
return pthread_mutex_trylock(&python_mutex) == 0; |
f2ef79f3dba0
Added native (not a plugin) asynchronous python eval function block - Beta. Code cleanup in C code templates.
etisserant
parents:
245
diff
changeset
|
192 |
} |
f2ef79f3dba0
Added native (not a plugin) asynchronous python eval function block - Beta. Code cleanup in C code templates.
etisserant
parents:
245
diff
changeset
|
193 |
|
f2ef79f3dba0
Added native (not a plugin) asynchronous python eval function block - Beta. Code cleanup in C code templates.
etisserant
parents:
245
diff
changeset
|
194 |
void UnLockPython(void) |
f2ef79f3dba0
Added native (not a plugin) asynchronous python eval function block - Beta. Code cleanup in C code templates.
etisserant
parents:
245
diff
changeset
|
195 |
{ |
f2ef79f3dba0
Added native (not a plugin) asynchronous python eval function block - Beta. Code cleanup in C code templates.
etisserant
parents:
245
diff
changeset
|
196 |
pthread_mutex_unlock(&python_mutex); |
f2ef79f3dba0
Added native (not a plugin) asynchronous python eval function block - Beta. Code cleanup in C code templates.
etisserant
parents:
245
diff
changeset
|
197 |
} |
f2ef79f3dba0
Added native (not a plugin) asynchronous python eval function block - Beta. Code cleanup in C code templates.
etisserant
parents:
245
diff
changeset
|
198 |
|
f2ef79f3dba0
Added native (not a plugin) asynchronous python eval function block - Beta. Code cleanup in C code templates.
etisserant
parents:
245
diff
changeset
|
199 |
void LockPython(void) |
f2ef79f3dba0
Added native (not a plugin) asynchronous python eval function block - Beta. Code cleanup in C code templates.
etisserant
parents:
245
diff
changeset
|
200 |
{ |
f2ef79f3dba0
Added native (not a plugin) asynchronous python eval function block - Beta. Code cleanup in C code templates.
etisserant
parents:
245
diff
changeset
|
201 |
pthread_mutex_lock(&python_mutex); |
f2ef79f3dba0
Added native (not a plugin) asynchronous python eval function block - Beta. Code cleanup in C code templates.
etisserant
parents:
245
diff
changeset
|
202 |
} |
483
bc26c42d2eec
fixed greg's crap in win32, enhanced debug stability, implemented preliminary retain
edouard
parents:
462
diff
changeset
|
203 |
|
522 | 204 |
int CheckRetainBuffer(void) |
205 |
{ |
|
206 |
return 1; |
|
207 |
} |
|
208 |
||
483
bc26c42d2eec
fixed greg's crap in win32, enhanced debug stability, implemented preliminary retain
edouard
parents:
462
diff
changeset
|
209 |
void Retain(unsigned int offset, unsigned int count, void *p) |
bc26c42d2eec
fixed greg's crap in win32, enhanced debug stability, implemented preliminary retain
edouard
parents:
462
diff
changeset
|
210 |
{ |
bc26c42d2eec
fixed greg's crap in win32, enhanced debug stability, implemented preliminary retain
edouard
parents:
462
diff
changeset
|
211 |
} |
bc26c42d2eec
fixed greg's crap in win32, enhanced debug stability, implemented preliminary retain
edouard
parents:
462
diff
changeset
|
212 |
|
bc26c42d2eec
fixed greg's crap in win32, enhanced debug stability, implemented preliminary retain
edouard
parents:
462
diff
changeset
|
213 |
void Remind(unsigned int offset, unsigned int count, void *p) |
bc26c42d2eec
fixed greg's crap in win32, enhanced debug stability, implemented preliminary retain
edouard
parents:
462
diff
changeset
|
214 |
{ |
bc26c42d2eec
fixed greg's crap in win32, enhanced debug stability, implemented preliminary retain
edouard
parents:
462
diff
changeset
|
215 |
} |