summaryrefslogtreecommitdiffstats
path: root/schedsim/shell/shared/main_semobtain.c
blob: d5b4388849e44785b20d9cd8e7daa113c2cc1b3c (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
85
86
87
88
89
90
91
92
93
94
95
/*
 *  Task Delete Shell Command Implmentation
 *
 *  COPYRIGHT (c) 1989-2013.
 *  On-Line Applications Research Corporation (OAR).
 *
 *  The license and distribution terms for this file may be
 *  found in the file LICENSE in this distribution or at
 *  http://www.rtems.com/license/LICENSE.
 */

#ifdef HAVE_CONFIG_H
#include "config.h"
#endif

#include <stdio.h>

#include <rtems.h>
#include "shell.h"
#include <rtems/stringto.h>
#include <schedsim_shell.h>
#include <rtems/error.h>

static Thread_Control *get_thread_executing(void)
{
  Thread_Control *e;

  _Thread_Disable_dispatch();
    e = _Thread_Executing;
  _Thread_Enable_dispatch();
  return e;
}

int rtems_shell_main_semaphore_obtain(
  int   argc,
  char *argv[]
)
{
  rtems_id           id;
  rtems_status_code  status;
  long               tmp;
  rtems_interval     ticks;
  Thread_Control    *caller;

  /* XXX for now, do not support polling */

  CHECK_RTEMS_IS_UP();

  if (argc != 3) {
    fprintf( stderr, "%s: Usage name|id timeout\n", argv[0] );
    return -1;
  }

  if ( lookup_semaphore( argv[1], &id ) )
    return -1;

  if ( rtems_string_to_long(argv[2], &tmp, NULL, 0) ) {
    printf( "Ceiling argument (%s) is not a number\n", argv[1] );
    return -1;
  }
  ticks = tmp;

  /*
   *  Now obtain the semaphore
   *
   *  If the calling thread blocks, we will return as another thread
   *  but with a "unsatisfied" return code.  So we check that we did
   *  a thread switch inside the semaphore obtain.  If we did, then
   *  just return successfully.
   */
  caller = get_thread_executing();
  printf("Obtain semaphore (0x%08x) with timeout %d\n", id, ticks );
  status = rtems_semaphore_obtain( id, RTEMS_DEFAULT_OPTIONS, ticks );
  if ( caller == get_thread_executing() ) {
    if ( status != RTEMS_SUCCESSFUL ) {
      fprintf(
        stderr,
        "Semaphore obtain(%s) returned %s\n",
        argv[1],
        rtems_status_text( status )
      );
      return -1;
    }
  }
  return 0;
}

rtems_shell_cmd_t rtems_shell_SEMAPHORE_OBTAIN_Command = {
  "semaphore_obtain",                /* name */
  "semaphore_obtain name ticks",     /* usage */
  "rtems",                           /* topic */
  rtems_shell_main_semaphore_obtain, /* command */
  NULL,                              /* alias */
  NULL                               /* next */
};