rtx_delay.c 2.5 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899
  1. /*
  2. * Copyright (c) 2013-2018 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. EvrRtxThreadDelayCompleted();
  33. }
  34. }
  35. return osOK;
  36. }
  37. /// Wait until specified time.
  38. /// \note API identical to osDelayUntil
  39. static osStatus_t svcRtxDelayUntil (uint32_t ticks) {
  40. ticks -= osRtxInfo.kernel.tick;
  41. if (ticks == 0xFFFFFFFFU) {
  42. EvrRtxThreadError(NULL, (int32_t)osErrorParameter);
  43. //lint -e{904} "Return statement before end of function" [MISRA Note 1]
  44. return osErrorParameter;
  45. }
  46. if (ticks != 0U) {
  47. if (!osRtxThreadWaitEnter(osRtxThreadWaitingDelay, ticks)) {
  48. EvrRtxThreadDelayCompleted();
  49. }
  50. }
  51. return osOK;
  52. }
  53. // Service Calls definitions
  54. //lint ++flb "Library Begin" [MISRA Note 11]
  55. SVC0_1(Delay, osStatus_t, uint32_t)
  56. SVC0_1(DelayUntil, osStatus_t, uint32_t)
  57. //lint --flb "Library End"
  58. // ==== Public API ====
  59. /// Wait for Timeout (Time Delay).
  60. osStatus_t osDelay (uint32_t ticks) {
  61. osStatus_t status;
  62. EvrRtxThreadDelay(ticks);
  63. if (IsIrqMode() || IsIrqMasked()) {
  64. EvrRtxThreadError(NULL, (int32_t)osErrorISR);
  65. status = osErrorISR;
  66. } else {
  67. status = __svcDelay(ticks);
  68. }
  69. return status;
  70. }
  71. /// Wait until specified time.
  72. osStatus_t osDelayUntil (uint32_t ticks) {
  73. osStatus_t status;
  74. EvrRtxThreadDelayUntil(ticks);
  75. if (IsIrqMode() || IsIrqMasked()) {
  76. EvrRtxThreadError(NULL, (int32_t)osErrorISR);
  77. status = osErrorISR;
  78. } else {
  79. status = __svcDelayUntil(ticks);
  80. }
  81. return status;
  82. }