Rev 264 | Go to most recent revision | Only display areas with differences | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed
| Rev 264 | Rev 266 | ||
|---|---|---|---|
| 1 | /************************************** |
1 | /************************************** |
| 2 | * |
2 | * |
| 3 | * WatchDog for MK-Connection |
3 | * WatchDog for MK-Connection |
| 4 | * |
4 | * |
| 5 | * Author: Marcus -LiGi- Bueschleb |
5 | * Author: Marcus -LiGi- Bueschleb |
| 6 | * |
6 | * |
| 7 | * see README for further Infos |
7 | * see README for further Infos |
| 8 | * |
8 | * |
| 9 | * |
9 | * |
| 10 | 10 | ||
| 11 | **************************************/ |
11 | **************************************/ |
| 12 | package org.ligi.ufo; |
12 | package org.ligi.ufo; |
| 13 | 13 | ||
| 14 | public class MKWatchDog |
14 | public class MKWatchDog |
| 15 | implements Runnable,DUBwiseDefinitions |
15 | implements Runnable,DUBwiseDefinitions |
| 16 | { |
16 | { |
| 17 | MKCommunicator mk=null; |
17 | MKCommunicator mk=null; |
| 18 | 18 | ||
| 19 | int debug_data_count_buff=-123; |
19 | int bytes_in_count_buff=-123; |
| 20 | 20 | ||
| 21 | public MKWatchDog(MKCommunicator _mk) |
21 | public MKWatchDog(MKCommunicator _mk) |
| 22 | { |
22 | { |
| 23 | 23 | ||
| 24 | mk=_mk; |
24 | mk=_mk; |
| 25 | new Thread( this ).start(); // fire up main Thread |
25 | new Thread( this ).start(); // fire up main Thread |
| 26 | } |
26 | } |
| 27 | 27 | ||
| 28 | 28 | ||
| 29 | public int act_paramset=0; |
29 | public int act_paramset=0; |
| 30 | int conn_check_timeout=0; |
30 | int conn_check_timeout=0; |
| 31 | 31 | ||
| 32 | 32 | ||
| 33 | public byte resend_timeout=0; |
33 | public byte resend_timeout=0; |
| 34 | int last_count=0; |
34 | int last_count=0; |
| 35 | 35 | ||
| 36 | 36 | ||
| 37 | public boolean resend_check(int ref_count) |
37 | public boolean resend_check(int ref_count) |
| 38 | { |
38 | { |
| 39 | if (( last_count!=ref_count)||(resend_timeout<0)) |
39 | if (( last_count!=ref_count)||(resend_timeout<0)) |
| 40 | { |
40 | { |
| 41 | if (resend_timeout<0) mk.stats.resend_count++; |
41 | if (resend_timeout<0) mk.stats.resend_count++; |
| 42 | last_count=ref_count; |
42 | last_count=ref_count; |
| 43 | resend_timeout=20; |
43 | resend_timeout=20; |
| 44 | return true; |
44 | return true; |
| 45 | } |
45 | } |
| 46 | else |
46 | else |
| 47 | resend_timeout--; |
47 | resend_timeout--; |
| 48 | 48 | ||
| 49 | return false; |
49 | return false; |
| 50 | } |
50 | } |
| 51 | 51 | ||
| 52 | //#ifdef android |
52 | //#ifdef android |
| 53 | // public final static int BASE_SLEEP=50; |
53 | // public final static int BASE_SLEEP=50; |
| 54 | //#else |
54 | //#else |
| 55 | public final static int BASE_SLEEP=10; |
55 | public final static int BASE_SLEEP=10; |
| 56 | //#endif |
56 | //#endif |
| 57 | 57 | ||
| 58 | public void run() |
58 | public void run() |
| 59 | { |
59 | { |
| 60 | mk.log("starting Watchdog"); |
60 | mk.log("starting Watchdog"); |
| 61 | // get all params |
61 | // get all params |
| 62 | int act_debug_name=0; |
62 | int act_debug_name=0; |
| 63 | // int sleeper=BASE_SLEEP; |
63 | // int sleeper=BASE_SLEEP; |
| 64 | while(true) |
64 | while(true) |
| 65 | { |
65 | { |
| 66 | try { |
66 | try { |
| 67 | Thread.sleep(BASE_SLEEP); |
67 | Thread.sleep(BASE_SLEEP); |
| 68 | // sleeper=BASE_SLEEP; |
68 | // sleeper=BASE_SLEEP; |
| 69 | if (mk.connected&&(!mk.force_disconnect)) |
69 | if (mk.connected&&(!mk.force_disconnect)) |
| 70 | { |
70 | { |
| 71 | 71 | ||
| 72 | // mk.log("watchdog pre main loop"); |
72 | // mk.log("watchdog pre main loop"); |
| 73 | if (mk.init_bootloader) |
73 | if (mk.init_bootloader) |
| 74 | { |
74 | { |
| 75 | mk.jump_bootloader(); |
75 | mk.jump_bootloader(); |
| 76 | mk.init_bootloader=false; |
76 | mk.init_bootloader=false; |
| 77 | } |
77 | } |
| 78 | else if ( mk.version.major==-1 ) |
78 | else if ( mk.version.major==-1 ) |
| 79 | mk.get_version(); |
79 | mk.get_version(); |
| 80 | else if (mk.ufo_prober.is_navi()&&(mk.error_str==null)) |
80 | else if (mk.ufo_prober.is_navi()&&(mk.error_str==null)) |
| 81 | mk.get_error_str(); |
81 | mk.get_error_str(); |
| 82 | 82 | ||
| 83 | else if (mk.ufo_prober.is_mk()&&(mk.params.last_parsed_paramset==-1)) |
83 | else if (mk.ufo_prober.is_mk()&&(mk.params.last_parsed_paramset==-1)) |
| 84 | { |
84 | { |
| 85 | mk.get_params(0xFF-1); |
85 | mk.get_params(0xFF-1); |
| 86 | Thread.sleep(150); |
86 | Thread.sleep(150); |
| 87 | 87 | ||
| 88 | act_paramset=0; // warning - if dropped problem |
88 | act_paramset=0; // warning - if dropped problem |
| 89 | } |
89 | } |
| 90 | else switch (mk.user_intent) |
90 | else switch (mk.user_intent) |
| 91 | { |
91 | { |
| 92 | case USER_INTENT_PARAMS: |
92 | case USER_INTENT_PARAMS: |
| 93 | 93 | ||
| 94 | if ((act_paramset<5)) |
94 | if ((act_paramset<5)) |
| 95 | { |
95 | { |
| 96 | 96 | ||
| 97 | if (resend_timeout==0) { |
97 | if (resend_timeout==0) { |
| 98 | mk.get_params(act_paramset); |
98 | mk.get_params(act_paramset); |
| 99 | resend_timeout=120; |
99 | resend_timeout=120; |
| 100 | } |
100 | } |
| 101 | 101 | ||
| 102 | if(mk.params.field[act_paramset]!=null) |
102 | if(mk.params.field[act_paramset]!=null) |
| 103 | { |
103 | { |
| 104 | mk.get_params(++act_paramset); |
104 | mk.get_params(++act_paramset); |
| 105 | resend_timeout=120; |
105 | resend_timeout=120; |
| 106 | } |
106 | } |
| 107 | else |
107 | else |
| 108 | resend_timeout--; |
108 | resend_timeout--; |
| 109 | /* |
109 | /* |
| 110 | // act_paramset++; |
110 | // act_paramset++; |
| 111 | else |
111 | else |
| 112 | mk.get_params(act_paramset); |
112 | mk.get_params(act_paramset); |
| 113 | |
113 | |
| 114 | sleeper+=1200; |
114 | sleeper+=1200; |
| 115 | */ |
115 | */ |
| 116 | } |
116 | } |
| 117 | break; |
117 | break; |
| 118 | case USER_INTENT_RAWDEBUG: |
118 | case USER_INTENT_RAWDEBUG: |
| 119 | if (act_debug_name<32) |
119 | if (act_debug_name<32) |
| 120 | { |
120 | { |
| 121 | 121 | ||
| 122 | if (resend_timeout==0) { |
122 | if (resend_timeout==0) { |
| 123 | mk.get_debug_name(act_debug_name); |
123 | mk.get_debug_name(act_debug_name); |
| 124 | resend_timeout=50; |
124 | resend_timeout=50; |
| 125 | } |
125 | } |
| 126 | 126 | ||
| 127 | 127 | ||
| 128 | //sleeper+=100; |
128 | //sleeper+=100; |
| 129 | if (mk.debug_data.got_name[act_debug_name]) |
129 | if (mk.debug_data.got_name[act_debug_name]) |
| 130 | { |
130 | { |
| 131 | mk.get_debug_name(++act_debug_name); |
131 | mk.get_debug_name(++act_debug_name); |
| 132 | resend_timeout=50; |
132 | resend_timeout=50; |
| 133 | } |
133 | } |
| 134 | else |
134 | else |
| 135 | resend_timeout--; |
135 | resend_timeout--; |
| 136 | 136 | ||
| 137 | } |
137 | } |
| 138 | else |
138 | else |
| 139 | if (!(mk.debug_data.got_name[0])) |
139 | if (!(mk.debug_data.got_name[0])) |
| 140 | act_debug_name=0; |
140 | act_debug_name=0; |
| 141 | 141 | ||
| 142 | break; |
142 | break; |
| 143 | 143 | ||
| 144 | case USER_INTENT_RCDATA: |
144 | case USER_INTENT_RCDATA: |
| 145 | if ( resend_check(mk.stats.stick_data_count) ) |
145 | if ( resend_check(mk.stats.stick_data_count) ) |
| 146 | mk.trigger_rcdata(); |
146 | mk.trigger_rcdata(); |
| 147 | break; |
147 | break; |
| 148 | 148 | ||
| 149 | case USER_INTENT_EXTERNAL_CONTROL: |
149 | case USER_INTENT_EXTERNAL_CONTROL: |
| 150 | if (resend_check(mk.stats.external_control_confirm_frame_count)) |
150 | if (resend_check(mk.stats.external_control_confirm_frame_count)) |
| 151 | { |
151 | { |
| 152 | mk.send_extern_control(); |
152 | mk.send_extern_control(); |
| 153 | mk.send_extern_control(); |
153 | mk.send_extern_control(); |
| 154 | mk.send_extern_control(); |
154 | mk.send_extern_control(); |
| 155 | mk.send_extern_control(); |
155 | mk.send_extern_control(); |
| 156 | } |
156 | } |
| 157 | 157 | ||
| 158 | break; |
158 | break; |
| 159 | 159 | ||
| 160 | 160 | ||
| 161 | case USER_INTENT_LCD: |
161 | case USER_INTENT_LCD: |
| 162 | if (resend_check(mk.stats.lcd_data_count)) |
162 | if (resend_check(mk.stats.lcd_data_count)) |
| 163 | mk.LCD.trigger_LCD(); |
163 | mk.LCD.trigger_LCD(); |
| 164 | 164 | ||
| 165 | break; |
165 | break; |
| 166 | 166 | ||
| 167 | case USER_INTENT_GPSOSD: |
167 | case USER_INTENT_GPSOSD: |
| 168 | mk.set_gpsosd_interval(1); |
168 | mk.set_gpsosd_interval(1); |
| 169 | break; |
169 | break; |
| 170 | case USER_INTENT_GRAPH: |
170 | case USER_INTENT_GRAPH: |
| 171 | mk.set_debug_interval(1); |
171 | mk.set_debug_interval(1); |
| 172 | break; |
172 | break; |
| 173 | 173 | ||
| 174 | default: |
174 | default: |
| 175 | // mk.log("uncactched intent " +mk.root.canvas.user_intent ); |
175 | // mk.log("uncactched intent " +mk.root.canvas.user_intent ); |
| 176 | break; |
176 | break; |
| 177 | } |
177 | } |
| 178 | - | ||
| 179 | // if ((!mk.ufo_prober.is_incompatible())) |
- | |
| 180 | {/* |
- | |
| 181 | |
- | |
| 182 | mk.log("watchdog after main loop"); |
- | |
| 183 | if (debug_data_count_buff==mk.stats.debug_data_count) |
- | |
| 184 | { |
- | |
| 185 | mk.log("timeout:" +conn_check_timeout ); |
- | |
| 186 | conn_check_timeout++; |
- | |
| 187 | if (conn_check_timeout==1000) |
- | |
| 188 | { |
- | |
| 189 | mk.log("disconnecting"); |
- | |
| 190 | mk.close_connections(false); |
- | |
| 191 | conn_check_timeout=0; |
- | |
| 192 | } |
- | |
| 193 | debug_data_count_buff=mk.stats.debug_data_count; |
- | |
| 194 | } |
- | |
| 195 | else |
- | |
| 196 | conn_check_timeout=0; |
- | |
| 197 | |
- | |
| 198 | - | ||
| 199 | */ |
- | |
| 200 | /*else if ((mk.root.canvas.user_intent==USER_INTENT_RAWDEBUG) || (mk.root.canvas.user_intent==USER_INTENT_GRAPH) ) |
- | |
| 201 | { |
- | |
| 202 | mk.trigger_debug(); |
- | |
| 203 | try { Thread.sleep(100); } |
- | |
| 204 | catch (Exception e) { } |
- | |
| 205 | } |
- | |
| 206 | */ |
- | |
| 207 | - | ||
| 208 | - | ||
| 209 | - | ||
| 210 | - | ||
| 211 | - | ||
| - | 178 | ||
| - | 179 | ||
| - | 180 | ||
| - | 181 | if (bytes_in_count_buff==mk.stats.bytes_in) |
|
| - | 182 | if ((conn_check_timeout++)*BASE_SLEEP>3000) |
|
| 212 | - | ||
| 213 | /* |
183 | { |
| 214 | - | ||
| 215 | 184 | conn_check_timeout=0; |
|
| - | 185 | mk.close_connections(false); |
|
| - | 186 | ||
| 216 | if (debug_data_count_buff==mk.debug_data_count) |
- | |
| 217 | { |
- | |
| 218 | // mk.close_connections(false); |
- | |
| 219 | } |
- | |
| 220 | - | ||
| 221 | */ |
- | |
| 222 | - | ||
| 223 | /*if (mk.version.major==-1) |
- | |
| 224 | mk.get_version(); |
- | |
| 225 | else |
- | |
| 226 | */ |
- | |
| 227 | /*for ( int cnt=0;cnt<5;cnt++) |
- | |
| 228 | if (mk.params.field[cnt]==null) |
- | |
| 229 | { |
- | |
| 230 | mk.get_params(cnt+1); |
- | |
| 231 | break; |
- | |
| 232 | }*/ |
- | |
| 233 | /* |
- | |
| 234 | for (int c=0;c<32;c++) |
- | |
| 235 | if (!mk.debug_data.got_name[c]) |
- | |
| 236 | { |
- | |
| 237 | mk.get_debug_name(c); |
- | |
| 238 | break; |
- | |
| 239 | } |
187 | } |
| 240 | */ |
188 | else |
| 241 | 189 | conn_check_timeout=0; |
|
| 242 | 190 | bytes_in_count_buff=mk.stats.debug_data_count; |
|
| 243 | } |
191 | |
| 244 | 192 | ||
| 245 | } |
193 | } |
| 246 | 194 | ||
| 247 | 195 | ||
| 248 | } // 3000 |
196 | } // 3000 |
| 249 | catch (Exception e) { |
197 | catch (Exception e) { |
| 250 | mk.log("err in watchdog:"); |
198 | mk.log("err in watchdog:"); |
| 251 | mk.log(e.toString()); |
199 | mk.log(e.toString()); |
| 252 | 200 | ||
| 253 | } |
201 | } |
| 254 | } |
202 | } |
| 255 | 203 | ||
| 256 | 204 | ||
| 257 | // mk.log("watchdog quit"); |
205 | // mk.log("watchdog quit"); |
| 258 | } |
206 | } |
| 259 | 207 | ||
| 260 | 208 | ||
| 261 | } |
209 | } |
| 262 | 210 | ||