blob: 403c6ed097d84a87cd05835a7557fbd6ea727cc0 (
plain) (
blame)
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
|
/**
* @file
*
* @brief RTEMS Rate Monotonic Get Status
* @ingroup ClassicRateMon
*/
/*
* COPYRIGHT (c) 1989-2009.
* On-Line Applications Research Corporation (OAR).
* Copyright (c) 2016 embedded brains GmbH.
*
* The license and distribution terms for this file may be
* found in the file LICENSE in this distribution or at
* http://www.rtems.org/license/LICENSE.
*/
#if HAVE_CONFIG_H
#include "config.h"
#endif
#include <rtems/rtems/ratemonimpl.h>
rtems_status_code rtems_rate_monotonic_get_status(
rtems_id id,
rtems_rate_monotonic_period_status *period_status
)
{
Rate_monotonic_Control *the_period;
ISR_lock_Context lock_context;
rtems_status_code status;
if ( period_status == NULL ) {
return RTEMS_INVALID_ADDRESS;
}
the_period = _Rate_monotonic_Get( id, &lock_context );
if ( the_period == NULL ) {
return RTEMS_INVALID_ID;
}
_Rate_monotonic_Acquire_critical( the_period, &lock_context );
period_status->owner = the_period->owner->Object.id;
period_status->state = the_period->state;
if ( the_period->state == RATE_MONOTONIC_INACTIVE ) {
/*
* If the period is inactive, there is no information.
*/
_Timespec_Set_to_zero( &period_status->since_last_period );
_Timespec_Set_to_zero( &period_status->executed_since_last_period );
status = RTEMS_SUCCESSFUL;
} else {
Timestamp_Control wall_since_last_period;
Timestamp_Control cpu_since_last_period;
bool valid_status;
/*
* Grab the current status.
*/
valid_status = _Rate_monotonic_Get_status(
the_period,
&wall_since_last_period,
&cpu_since_last_period
);
if ( valid_status ) {
_Timestamp_To_timespec(
&wall_since_last_period,
&period_status->since_last_period
);
_Timestamp_To_timespec(
&cpu_since_last_period,
&period_status->executed_since_last_period
);
status = RTEMS_SUCCESSFUL;
} else {
status = RTEMS_NOT_DEFINED;
}
}
_Rate_monotonic_Release( the_period, &lock_context );
return status;
}
|
