rtx_delay.c 2.6 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101
  1. /*
  2. * Copyright (c) 2013-2019 Arm Limited. All rights reserved.
  3. *
  4. * SPDX-License-Identifier: Apache-2.0
  5. *
  6. * Licensed under the Apache License, Version 2.0 (the License); you may
  7. * not use this file except in compliance with the License.
  8. * You may obtain a copy of the License at
  9. *
  10. * www.apache.org/licenses/LICENSE-2.0
  11. *
  12. * Unless required by applicable law or agreed to in writing, software
  13. * distributed under the License is distributed on an AS IS BASIS, WITHOUT
  14. * WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
  15. * See the License for the specific language governing permissions and
  16. * limitations under the License.
  17. *
  18. * -----------------------------------------------------------------------------
  19. *
  20. * Project: CMSIS-RTOS RTX
  21. * Title: Delay functions
  22. *
  23. * -----------------------------------------------------------------------------
  24. */
  25. #include "rtx_lib.h"
  26. // ==== Service Calls ====
  27. /// Wait for Timeout (Time Delay).
  28. /// \note API identical to osDelay
  29. static osStatus_t svcRtxDelay (uint32_t ticks) {
  30. if (ticks != 0U) {
  31. if (osRtxThreadWaitEnter(osRtxThreadWaitingDelay, ticks)) {
  32. EvrRtxDelayStarted(ticks);
  33. } else {
  34. EvrRtxDelayCompleted(osRtxThreadGetRunning());
  35. }
  36. }
  37. return osOK;
  38. }
  39. /// Wait until specified time.
  40. /// \note API identical to osDelayUntil
  41. static osStatus_t svcRtxDelayUntil (uint32_t ticks) {
  42. ticks -= osRtxInfo.kernel.tick;
  43. if ((ticks == 0U) || (ticks > 0x7FFFFFFFU)) {
  44. EvrRtxDelayError((int32_t)osErrorParameter);
  45. //lint -e{904} "Return statement before end of function" [MISRA Note 1]
  46. return osErrorParameter;
  47. }
  48. if (osRtxThreadWaitEnter(osRtxThreadWaitingDelay, ticks)) {
  49. EvrRtxDelayUntilStarted(ticks);
  50. } else {
  51. EvrRtxDelayCompleted(osRtxThreadGetRunning());
  52. }
  53. return osOK;
  54. }
  55. // Service Calls definitions
  56. //lint ++flb "Library Begin" [MISRA Note 11]
  57. SVC0_1(Delay, osStatus_t, uint32_t)
  58. SVC0_1(DelayUntil, osStatus_t, uint32_t)
  59. //lint --flb "Library End"
  60. // ==== Public API ====
  61. /// Wait for Timeout (Time Delay).
  62. osStatus_t osDelay (uint32_t ticks) {
  63. osStatus_t status;
  64. EvrRtxDelay(ticks);
  65. if (IsIrqMode() || IsIrqMasked()) {
  66. EvrRtxDelayError((int32_t)osErrorISR);
  67. status = osErrorISR;
  68. } else {
  69. status = __svcDelay(ticks);
  70. }
  71. return status;
  72. }
  73. /// Wait until specified time.
  74. osStatus_t osDelayUntil (uint32_t ticks) {
  75. osStatus_t status;
  76. EvrRtxDelayUntil(ticks);
  77. if (IsIrqMode() || IsIrqMasked()) {
  78. EvrRtxDelayError((int32_t)osErrorISR);
  79. status = osErrorISR;
  80. } else {
  81. status = __svcDelayUntil(ticks);
  82. }
  83. return status;
  84. }