source: rtems/testsuites/smptests/smpscheduler02/init.c @ 16347a6

5
Last change on this file since 16347a6 was 16347a6, checked in by Sebastian Huber <sebastian.huber@…>, on 07/07/17 at 05:36:52

score: Fix default set affinity

The set of online processors must be a subset of the thread processor
affinity for the schedulers without arbitrary processor affinity support
to avoid problems in case of processor addition and removal.

Update #3059.
  • Property mode set to 100644
File size: 14.4 KB
Line 
1/*
2 * Copyright (c) 2014, 2017 embedded brains GmbH.  All rights reserved.
3 *
4 *  embedded brains GmbH
5 *  Dornierstr. 4
6 *  82178 Puchheim
7 *  Germany
8 *  <rtems@embedded-brains.de>
9 *
10 * The license and distribution terms for this file may be
11 * found in the file LICENSE in this distribution or at
12 * http://www.rtems.org/license/LICENSE.
13 */
14
15#ifdef HAVE_CONFIG_H
16  #include "config.h"
17#endif
18
19#include <sched.h>
20
21#include <rtems.h>
22#include <rtems/libcsupport.h>
23
24#include "tmacros.h"
25
26const char rtems_test_name[] = "SMPSCHEDULER 2";
27
28#define SCHED_A rtems_build_name(' ', ' ', ' ', 'A')
29
30#define SCHED_B rtems_build_name(' ', ' ', ' ', 'B')
31
32#define SCHED_C rtems_build_name(' ', ' ', ' ', 'C')
33
34static rtems_id main_task_id;
35
36static rtems_id cmtx_id;
37
38static rtems_id imtx_id;
39
40static volatile bool ready;
41
42static void task(rtems_task_argument arg)
43{
44  rtems_status_code sc;
45
46  (void) arg;
47
48  rtems_test_assert(rtems_get_current_processor() == 1);
49  rtems_test_assert(sched_get_priority_min(SCHED_RR) == 1);
50  rtems_test_assert(sched_get_priority_max(SCHED_RR) == 126);
51
52  sc = rtems_semaphore_obtain(cmtx_id, RTEMS_WAIT, RTEMS_NO_TIMEOUT);
53  rtems_test_assert(sc == RTEMS_NOT_DEFINED);
54
55  sc = rtems_event_transient_send(main_task_id);
56  rtems_test_assert(sc == RTEMS_SUCCESSFUL);
57
58  sc = rtems_semaphore_obtain(imtx_id, RTEMS_WAIT, RTEMS_NO_TIMEOUT);
59  rtems_test_assert(sc == RTEMS_SUCCESSFUL);
60
61  sc = rtems_semaphore_release(imtx_id);
62  rtems_test_assert(sc == RTEMS_SUCCESSFUL);
63
64  sc = rtems_event_transient_send(main_task_id);
65  rtems_test_assert(sc == RTEMS_SUCCESSFUL);
66
67  while (1) {
68    /* Do nothing */
69  }
70}
71
72static void sticky_task(rtems_task_argument arg)
73{
74  rtems_status_code sc;
75  rtems_id mtx_id;
76
77  (void) arg;
78
79  rtems_test_assert(rtems_get_current_processor() == 0);
80
81  sc = rtems_semaphore_create(
82    rtems_build_name(' ', 'M', 'T', 'X'),
83    1,
84    RTEMS_BINARY_SEMAPHORE | RTEMS_MULTIPROCESSOR_RESOURCE_SHARING,
85    2,
86    &mtx_id
87  );
88  rtems_test_assert(sc == RTEMS_SUCCESSFUL);
89
90  sc = rtems_semaphore_obtain(mtx_id, RTEMS_WAIT, RTEMS_NO_TIMEOUT);
91  rtems_test_assert(sc == RTEMS_SUCCESSFUL);
92
93  ready = true;
94
95  sc = rtems_event_transient_receive(RTEMS_WAIT, RTEMS_NO_TIMEOUT);
96  rtems_test_assert(sc == RTEMS_SUCCESSFUL);
97
98  sc = rtems_semaphore_release(mtx_id);
99  rtems_test_assert(sc == RTEMS_SUCCESSFUL);
100
101  sc = rtems_semaphore_delete(mtx_id);
102  rtems_test_assert(sc == RTEMS_SUCCESSFUL);
103
104  sc = rtems_event_transient_send(main_task_id);
105  rtems_test_assert(sc == RTEMS_SUCCESSFUL);
106
107  while (1) {
108    /* Do nothing */
109  }
110}
111
112static void test_scheduler_add_remove_processors(void)
113{
114  rtems_status_code sc;
115  rtems_id scheduler_a_id;
116  rtems_id scheduler_c_id;
117
118  sc = rtems_scheduler_ident(SCHED_A, &scheduler_a_id);
119  rtems_test_assert(sc == RTEMS_SUCCESSFUL);
120
121  sc = rtems_scheduler_ident(SCHED_C, &scheduler_c_id);
122  rtems_test_assert(sc == RTEMS_SUCCESSFUL);
123
124  sc = rtems_scheduler_add_processor(scheduler_c_id, 62);
125  rtems_test_assert(sc == RTEMS_NOT_CONFIGURED);
126
127  sc = rtems_scheduler_add_processor(scheduler_c_id, 63);
128  rtems_test_assert(sc == RTEMS_INCORRECT_STATE);
129
130  sc = rtems_scheduler_remove_processor(scheduler_c_id, 62);
131  rtems_test_assert(sc == RTEMS_INVALID_NUMBER);
132
133  sc = rtems_scheduler_remove_processor(scheduler_a_id, 0);
134  rtems_test_assert(sc == RTEMS_RESOURCE_IN_USE);
135
136  if (rtems_get_processor_count() > 1) {
137    rtems_id scheduler_b_id;
138    rtems_id task_id;
139
140    sc = rtems_scheduler_ident(SCHED_B, &scheduler_b_id);
141    rtems_test_assert(sc == RTEMS_SUCCESSFUL);
142
143    sc = rtems_scheduler_remove_processor(scheduler_b_id, 1);
144    rtems_test_assert(sc == RTEMS_SUCCESSFUL);
145
146    sc = rtems_scheduler_add_processor(scheduler_a_id, 1);
147    rtems_test_assert(sc == RTEMS_SUCCESSFUL);
148
149    rtems_test_assert(rtems_get_current_processor() == 0);
150
151    sc = rtems_scheduler_remove_processor(scheduler_a_id, 0);
152    rtems_test_assert(sc == RTEMS_SUCCESSFUL);
153
154    rtems_test_assert(rtems_get_current_processor() == 1);
155
156    sc = rtems_scheduler_add_processor(scheduler_a_id, 0);
157    rtems_test_assert(sc == RTEMS_SUCCESSFUL);
158
159    rtems_test_assert(rtems_get_current_processor() == 1);
160
161    sc = rtems_task_create(
162      rtems_build_name('T', 'A', 'S', 'K'),
163      2,
164      RTEMS_MINIMUM_STACK_SIZE,
165      RTEMS_DEFAULT_MODES,
166      RTEMS_DEFAULT_ATTRIBUTES,
167      &task_id
168    );
169    rtems_test_assert(sc == RTEMS_SUCCESSFUL);
170
171    sc = rtems_task_start(task_id, sticky_task, 0);
172    rtems_test_assert(sc == RTEMS_SUCCESSFUL);
173
174    while (!ready) {
175      /* Wait */
176    }
177
178    sc = rtems_scheduler_remove_processor(scheduler_a_id, 1);
179    rtems_test_assert(sc == RTEMS_SUCCESSFUL);
180
181    rtems_test_assert(rtems_get_current_processor() == 0);
182
183    sc = rtems_event_transient_send(task_id);
184    rtems_test_assert(sc == RTEMS_SUCCESSFUL);
185
186    sc = rtems_event_transient_receive(RTEMS_WAIT, RTEMS_NO_TIMEOUT);
187    rtems_test_assert(sc == RTEMS_SUCCESSFUL);
188
189    sc = rtems_task_delete(task_id);
190    rtems_test_assert(sc == RTEMS_SUCCESSFUL);
191
192    sc = rtems_scheduler_add_processor(scheduler_b_id, 1);
193    rtems_test_assert(sc == RTEMS_SUCCESSFUL);
194  }
195}
196
197static void test(void)
198{
199  rtems_status_code sc;
200  rtems_id task_id;
201  rtems_id scheduler_id;
202  rtems_id scheduler_a_id;
203  rtems_id scheduler_b_id;
204  rtems_id scheduler_c_id;
205  rtems_task_priority prio;
206  cpu_set_t cpuset;
207  cpu_set_t first_cpu;
208  cpu_set_t second_cpu;
209  cpu_set_t all_cpus;
210  cpu_set_t online_cpus;
211  uint32_t cpu_count;
212
213  cpu_count = rtems_get_processor_count();
214  rtems_test_assert(cpu_count == 1 || cpu_count == 2);
215
216  rtems_test_assert(rtems_get_current_processor() == 0);
217
218  main_task_id = rtems_task_self();
219
220  CPU_ZERO(&first_cpu);
221  CPU_SET(0, &first_cpu);
222
223  CPU_ZERO(&second_cpu);
224  CPU_SET(1, &second_cpu);
225
226  CPU_FILL(&all_cpus);
227
228  CPU_ZERO(&online_cpus);
229  CPU_SET(0, &online_cpus);
230
231  if (cpu_count > 1) {
232    CPU_SET(1, &online_cpus);
233  }
234
235  sc = rtems_scheduler_ident(SCHED_A, &scheduler_a_id);
236  rtems_test_assert(sc == RTEMS_SUCCESSFUL);
237
238  if (cpu_count > 1) {
239    sc = rtems_scheduler_ident(SCHED_B, &scheduler_b_id);
240    rtems_test_assert(sc == RTEMS_SUCCESSFUL);
241    rtems_test_assert(scheduler_a_id != scheduler_b_id);
242  }
243
244  sc = rtems_scheduler_ident(SCHED_C, &scheduler_c_id);
245  rtems_test_assert(sc == RTEMS_SUCCESSFUL);
246
247  sc = rtems_semaphore_create(
248    rtems_build_name('C', 'M', 'T', 'X'),
249    1,
250    RTEMS_BINARY_SEMAPHORE | RTEMS_PRIORITY | RTEMS_PRIORITY_CEILING,
251    1,
252    &cmtx_id
253  );
254  rtems_test_assert(sc == RTEMS_SUCCESSFUL);
255
256  sc = rtems_semaphore_create(
257    rtems_build_name('I', 'M', 'T', 'X'),
258    1,
259    RTEMS_BINARY_SEMAPHORE | RTEMS_PRIORITY | RTEMS_INHERIT_PRIORITY,
260    1,
261    &imtx_id
262  );
263  rtems_test_assert(sc == RTEMS_SUCCESSFUL);
264
265  prio = 2;
266  sc = rtems_semaphore_set_priority(cmtx_id, scheduler_a_id, prio, &prio);
267  rtems_test_assert(sc == RTEMS_SUCCESSFUL);
268  rtems_test_assert(prio == 1);
269
270  if (cpu_count > 1) {
271    prio = 1;
272    sc = rtems_semaphore_set_priority(cmtx_id, scheduler_b_id, prio, &prio);
273    rtems_test_assert(sc == RTEMS_NOT_DEFINED);
274    rtems_test_assert(prio == 2);
275  }
276
277  CPU_ZERO(&cpuset);
278  sc = rtems_scheduler_get_processor_set(
279    scheduler_a_id,
280    sizeof(cpuset),
281    &cpuset
282  );
283  rtems_test_assert(sc == RTEMS_SUCCESSFUL);
284  rtems_test_assert(CPU_EQUAL(&cpuset, &first_cpu));
285
286  if (cpu_count > 1) {
287    CPU_ZERO(&cpuset);
288    sc = rtems_scheduler_get_processor_set(
289      scheduler_b_id,
290      sizeof(cpuset),
291      &cpuset
292    );
293    rtems_test_assert(sc == RTEMS_SUCCESSFUL);
294    rtems_test_assert(CPU_EQUAL(&cpuset, &second_cpu));
295  }
296
297  sc = rtems_task_create(
298    rtems_build_name('T', 'A', 'S', 'K'),
299    1,
300    RTEMS_MINIMUM_STACK_SIZE,
301    RTEMS_DEFAULT_MODES,
302    RTEMS_DEFAULT_ATTRIBUTES,
303    &task_id
304  );
305  rtems_test_assert(sc == RTEMS_SUCCESSFUL);
306
307  sc = rtems_task_get_scheduler(task_id, &scheduler_id);
308  rtems_test_assert(sc == RTEMS_SUCCESSFUL);
309  rtems_test_assert(scheduler_id == scheduler_a_id);
310
311  CPU_ZERO(&cpuset);
312  sc = rtems_task_get_affinity(task_id, sizeof(cpuset), &cpuset);
313  rtems_test_assert(sc == RTEMS_SUCCESSFUL);
314  rtems_test_assert(CPU_EQUAL(&cpuset, &online_cpus));
315
316  rtems_test_assert(sched_get_priority_min(SCHED_RR) == 1);
317  rtems_test_assert(sched_get_priority_max(SCHED_RR) == 254);
318
319  sc = rtems_task_set_scheduler(task_id, scheduler_c_id, 1);
320  rtems_test_assert(sc == RTEMS_UNSATISFIED);
321
322  sc = rtems_task_set_scheduler(task_id, scheduler_c_id + 1, 1);
323  rtems_test_assert(sc == RTEMS_INVALID_ID);
324
325  if (cpu_count > 1) {
326    sc = rtems_task_set_scheduler(task_id, scheduler_b_id, 1);
327    rtems_test_assert(sc == RTEMS_SUCCESSFUL);
328
329    sc = rtems_task_get_scheduler(task_id, &scheduler_id);
330    rtems_test_assert(sc == RTEMS_SUCCESSFUL);
331    rtems_test_assert(scheduler_id == scheduler_b_id);
332
333    CPU_ZERO(&cpuset);
334    sc = rtems_task_get_affinity(task_id, sizeof(cpuset), &cpuset);
335    rtems_test_assert(sc == RTEMS_SUCCESSFUL);
336    rtems_test_assert(CPU_EQUAL(&cpuset, &online_cpus));
337
338    sc = rtems_task_set_affinity(task_id, sizeof(all_cpus), &all_cpus);
339    rtems_test_assert(sc == RTEMS_SUCCESSFUL);
340
341    sc = rtems_task_set_affinity(task_id, sizeof(first_cpu), &first_cpu);
342    rtems_test_assert(sc == RTEMS_INVALID_NUMBER);
343
344    sc = rtems_task_get_scheduler(task_id, &scheduler_id);
345    rtems_test_assert(sc == RTEMS_SUCCESSFUL);
346    rtems_test_assert(scheduler_id == scheduler_b_id);
347
348    sc = rtems_task_set_affinity(task_id, sizeof(second_cpu), &second_cpu);
349    rtems_test_assert(sc == RTEMS_INVALID_NUMBER);
350
351    sc = rtems_task_set_affinity(task_id, sizeof(online_cpus), &online_cpus);
352    rtems_test_assert(sc == RTEMS_SUCCESSFUL);
353
354    sc = rtems_task_get_scheduler(task_id, &scheduler_id);
355    rtems_test_assert(sc == RTEMS_SUCCESSFUL);
356    rtems_test_assert(scheduler_id == scheduler_b_id);
357
358    sc = rtems_semaphore_obtain(imtx_id, RTEMS_WAIT, RTEMS_NO_TIMEOUT);
359    rtems_test_assert(sc == RTEMS_SUCCESSFUL);
360
361    sc = rtems_task_set_scheduler(task_id, scheduler_b_id, 1);
362    rtems_test_assert(sc == RTEMS_SUCCESSFUL);
363
364    sc = rtems_task_start(task_id, task, 0);
365    rtems_test_assert(sc == RTEMS_SUCCESSFUL);
366
367    sc = rtems_event_transient_receive(RTEMS_WAIT, RTEMS_NO_TIMEOUT);
368    rtems_test_assert(sc == RTEMS_SUCCESSFUL);
369
370    sc = rtems_task_set_scheduler(RTEMS_SELF, scheduler_b_id, 1);
371    rtems_test_assert(sc == RTEMS_RESOURCE_IN_USE);
372
373    sc = rtems_semaphore_release(imtx_id);
374    rtems_test_assert(sc == RTEMS_SUCCESSFUL);
375
376    sc = rtems_event_transient_receive(RTEMS_WAIT, RTEMS_NO_TIMEOUT);
377    rtems_test_assert(sc == RTEMS_SUCCESSFUL);
378  }
379
380  sc = rtems_task_delete(task_id);
381  rtems_test_assert(sc == RTEMS_SUCCESSFUL);
382
383  sc = rtems_semaphore_delete(cmtx_id);
384  rtems_test_assert(sc == RTEMS_SUCCESSFUL);
385
386  sc = rtems_semaphore_delete(imtx_id);
387  rtems_test_assert(sc == RTEMS_SUCCESSFUL);
388
389  test_scheduler_add_remove_processors();
390}
391
392static void Init(rtems_task_argument arg)
393{
394  rtems_resource_snapshot snapshot;
395
396  TEST_BEGIN();
397
398  rtems_resource_snapshot_take(&snapshot);
399
400  test();
401
402  rtems_test_assert(rtems_resource_snapshot_check(&snapshot));
403
404  TEST_END();
405  rtems_test_exit(0);
406}
407
408#define CONFIGURE_APPLICATION_NEEDS_CLOCK_DRIVER
409#define CONFIGURE_APPLICATION_NEEDS_CONSOLE_DRIVER
410
411#define CONFIGURE_MAXIMUM_TASKS 2
412#define CONFIGURE_MAXIMUM_SEMAPHORES 2
413#define CONFIGURE_MAXIMUM_MRSP_SEMAPHORES 1
414
415/* Lets see when the first RTEMS system hits this limit */
416#define CONFIGURE_MAXIMUM_PROCESSORS 64
417
418#define CONFIGURE_SCHEDULER_PRIORITY_SMP
419#define CONFIGURE_SCHEDULER_SIMPLE_SMP
420
421#include <rtems/scheduler.h>
422
423RTEMS_SCHEDULER_CONTEXT_PRIORITY_SMP(a, 256);
424
425RTEMS_SCHEDULER_CONTEXT_PRIORITY_SMP(b, 128);
426
427RTEMS_SCHEDULER_CONTEXT_SIMPLE_SMP(c);
428
429#define CONFIGURE_SCHEDULER_CONTROLS \
430  RTEMS_SCHEDULER_CONTROL_PRIORITY_SMP(a, SCHED_A), \
431  RTEMS_SCHEDULER_CONTROL_PRIORITY_SMP(b, SCHED_B), \
432  RTEMS_SCHEDULER_CONTROL_SIMPLE_SMP(c, SCHED_C)
433
434#define CONFIGURE_SMP_SCHEDULER_ASSIGNMENTS \
435  RTEMS_SCHEDULER_ASSIGN(0, RTEMS_SCHEDULER_ASSIGN_PROCESSOR_MANDATORY), \
436  RTEMS_SCHEDULER_ASSIGN(1, RTEMS_SCHEDULER_ASSIGN_PROCESSOR_OPTIONAL), \
437  RTEMS_SCHEDULER_ASSIGN_NO_SCHEDULER, RTEMS_SCHEDULER_ASSIGN_NO_SCHEDULER, \
438  RTEMS_SCHEDULER_ASSIGN_NO_SCHEDULER, RTEMS_SCHEDULER_ASSIGN_NO_SCHEDULER, \
439  RTEMS_SCHEDULER_ASSIGN_NO_SCHEDULER, RTEMS_SCHEDULER_ASSIGN_NO_SCHEDULER, \
440  RTEMS_SCHEDULER_ASSIGN_NO_SCHEDULER, RTEMS_SCHEDULER_ASSIGN_NO_SCHEDULER, \
441  RTEMS_SCHEDULER_ASSIGN_NO_SCHEDULER, RTEMS_SCHEDULER_ASSIGN_NO_SCHEDULER, \
442  RTEMS_SCHEDULER_ASSIGN_NO_SCHEDULER, RTEMS_SCHEDULER_ASSIGN_NO_SCHEDULER, \
443  RTEMS_SCHEDULER_ASSIGN_NO_SCHEDULER, RTEMS_SCHEDULER_ASSIGN_NO_SCHEDULER, \
444  RTEMS_SCHEDULER_ASSIGN_NO_SCHEDULER, RTEMS_SCHEDULER_ASSIGN_NO_SCHEDULER, \
445  RTEMS_SCHEDULER_ASSIGN_NO_SCHEDULER, RTEMS_SCHEDULER_ASSIGN_NO_SCHEDULER, \
446  RTEMS_SCHEDULER_ASSIGN_NO_SCHEDULER, RTEMS_SCHEDULER_ASSIGN_NO_SCHEDULER, \
447  RTEMS_SCHEDULER_ASSIGN_NO_SCHEDULER, RTEMS_SCHEDULER_ASSIGN_NO_SCHEDULER, \
448  RTEMS_SCHEDULER_ASSIGN_NO_SCHEDULER, RTEMS_SCHEDULER_ASSIGN_NO_SCHEDULER, \
449  RTEMS_SCHEDULER_ASSIGN_NO_SCHEDULER, RTEMS_SCHEDULER_ASSIGN_NO_SCHEDULER, \
450  RTEMS_SCHEDULER_ASSIGN_NO_SCHEDULER, RTEMS_SCHEDULER_ASSIGN_NO_SCHEDULER, \
451  RTEMS_SCHEDULER_ASSIGN_NO_SCHEDULER, RTEMS_SCHEDULER_ASSIGN_NO_SCHEDULER, \
452  RTEMS_SCHEDULER_ASSIGN_NO_SCHEDULER, RTEMS_SCHEDULER_ASSIGN_NO_SCHEDULER, \
453  RTEMS_SCHEDULER_ASSIGN_NO_SCHEDULER, RTEMS_SCHEDULER_ASSIGN_NO_SCHEDULER, \
454  RTEMS_SCHEDULER_ASSIGN_NO_SCHEDULER, RTEMS_SCHEDULER_ASSIGN_NO_SCHEDULER, \
455  RTEMS_SCHEDULER_ASSIGN_NO_SCHEDULER, RTEMS_SCHEDULER_ASSIGN_NO_SCHEDULER, \
456  RTEMS_SCHEDULER_ASSIGN_NO_SCHEDULER, RTEMS_SCHEDULER_ASSIGN_NO_SCHEDULER, \
457  RTEMS_SCHEDULER_ASSIGN_NO_SCHEDULER, RTEMS_SCHEDULER_ASSIGN_NO_SCHEDULER, \
458  RTEMS_SCHEDULER_ASSIGN_NO_SCHEDULER, RTEMS_SCHEDULER_ASSIGN_NO_SCHEDULER, \
459  RTEMS_SCHEDULER_ASSIGN_NO_SCHEDULER, RTEMS_SCHEDULER_ASSIGN_NO_SCHEDULER, \
460  RTEMS_SCHEDULER_ASSIGN_NO_SCHEDULER, RTEMS_SCHEDULER_ASSIGN_NO_SCHEDULER, \
461  RTEMS_SCHEDULER_ASSIGN_NO_SCHEDULER, RTEMS_SCHEDULER_ASSIGN_NO_SCHEDULER, \
462  RTEMS_SCHEDULER_ASSIGN_NO_SCHEDULER, RTEMS_SCHEDULER_ASSIGN_NO_SCHEDULER, \
463  RTEMS_SCHEDULER_ASSIGN_NO_SCHEDULER, RTEMS_SCHEDULER_ASSIGN_NO_SCHEDULER, \
464  RTEMS_SCHEDULER_ASSIGN_NO_SCHEDULER, RTEMS_SCHEDULER_ASSIGN_NO_SCHEDULER, \
465  RTEMS_SCHEDULER_ASSIGN_NO_SCHEDULER, RTEMS_SCHEDULER_ASSIGN_NO_SCHEDULER, \
466  RTEMS_SCHEDULER_ASSIGN_NO_SCHEDULER, RTEMS_SCHEDULER_ASSIGN_NO_SCHEDULER, \
467  RTEMS_SCHEDULER_ASSIGN_NO_SCHEDULER, \
468  RTEMS_SCHEDULER_ASSIGN(2, RTEMS_SCHEDULER_ASSIGN_PROCESSOR_OPTIONAL)
469
470#define CONFIGURE_INITIAL_EXTENSIONS RTEMS_TEST_INITIAL_EXTENSION
471
472#define CONFIGURE_RTEMS_INIT_TASKS_TABLE
473
474#define CONFIGURE_INIT
475
476#include <rtems/confdefs.h>
Note: See TracBrowser for help on using the repository browser.