semaphore.c
上传用户:lgb322
上传日期:2013-02-24
资源大小:30529k
文件大小:4k
源码类别:

嵌入式Linux

开发平台:

Unix_Linux

  1. /*
  2.  *  Generic semaphore code. Buyer beware. Do your own
  3.  * specific changes in <asm/semaphore-helper.h>
  4.  */
  5. #include <linux/sched.h>
  6. #include <asm/semaphore-helper.h>
  7. /*
  8.  * Semaphores are implemented using a two-way counter:
  9.  * The "count" variable is decremented for each process
  10.  * that tries to sleep, while the "waking" variable is
  11.  * incremented when the "up()" code goes to wake up waiting
  12.  * processes.
  13.  *
  14.  * Notably, the inline "up()" and "down()" functions can
  15.  * efficiently test if they need to do any extra work (up
  16.  * needs to do something only if count was negative before
  17.  * the increment operation.
  18.  *
  19.  * waking_non_zero() (from asm/semaphore.h) must execute
  20.  * atomically.
  21.  *
  22.  * When __up() is called, the count was negative before
  23.  * incrementing it, and we need to wake up somebody.
  24.  *
  25.  * This routine adds one to the count of processes that need to
  26.  * wake up and exit.  ALL waiting processes actually wake up but
  27.  * only the one that gets to the "waking" field first will gate
  28.  * through and acquire the semaphore.  The others will go back
  29.  * to sleep.
  30.  *
  31.  * Note that these functions are only called when there is
  32.  * contention on the lock, and as such all this is the
  33.  * "non-critical" part of the whole semaphore business. The
  34.  * critical part is the inline stuff in <asm/semaphore.h>
  35.  * where we want to avoid any extra jumps and calls.
  36.  */
  37. void __up(struct semaphore *sem)
  38. {
  39. wake_one_more(sem);
  40. wake_up(&sem->wait);
  41. }
  42. /*
  43.  * Perform the "down" function.  Return zero for semaphore acquired,
  44.  * return negative for signalled out of the function.
  45.  *
  46.  * If called from __down, the return is ignored and the wait loop is
  47.  * not interruptible.  This means that a task waiting on a semaphore
  48.  * using "down()" cannot be killed until someone does an "up()" on
  49.  * the semaphore.
  50.  *
  51.  * If called from __down_interruptible, the return value gets checked
  52.  * upon return.  If the return value is negative then the task continues
  53.  * with the negative value in the return register (it can be tested by
  54.  * the caller).
  55.  *
  56.  * Either form may be used in conjunction with "up()".
  57.  *
  58.  */
  59. #define DOWN_VAR
  60. struct task_struct *tsk = current;
  61. wait_queue_t wait;
  62. init_waitqueue_entry(&wait, tsk);
  63. #define DOWN_HEAD(task_state)
  64. tsk->state = (task_state);
  65. add_wait_queue(&sem->wait, &wait);
  66. /*
  67.  * Ok, we're set up.  sem->count is known to be less than zero
  68.  * so we must wait.
  69.  *
  70.  * We can let go the lock for purposes of waiting.
  71.  * We re-acquire it after awaking so as to protect
  72.  * all semaphore operations.
  73.  *
  74.  * If "up()" is called before we call waking_non_zero() then
  75.  * we will catch it right away.  If it is called later then
  76.  * we will have to go through a wakeup cycle to catch it.
  77.  *
  78.  * Multiple waiters contend for the semaphore lock to see
  79.  * who gets to gate through and who has to wait some more.
  80.  */
  81. for (;;) {
  82. #define DOWN_TAIL(task_state)
  83. tsk->state = (task_state);
  84. }
  85. tsk->state = TASK_RUNNING;
  86. remove_wait_queue(&sem->wait, &wait);
  87. void __down(struct semaphore * sem)
  88. {
  89. DOWN_VAR
  90. DOWN_HEAD(TASK_UNINTERRUPTIBLE)
  91. if (waking_non_zero(sem))
  92. break;
  93. schedule();
  94. DOWN_TAIL(TASK_UNINTERRUPTIBLE)
  95. }
  96. int __down_interruptible(struct semaphore * sem)
  97. {
  98. int ret = 0;
  99. DOWN_VAR
  100. DOWN_HEAD(TASK_INTERRUPTIBLE)
  101. ret = waking_non_zero_interruptible(sem, tsk);
  102. if (ret)
  103. {
  104. if (ret == 1)
  105. /* ret != 0 only if we get interrupted -arca */
  106. ret = 0;
  107. break;
  108. }
  109. schedule();
  110. DOWN_TAIL(TASK_INTERRUPTIBLE)
  111. return ret;
  112. }
  113. int __down_trylock(struct semaphore * sem)
  114. {
  115. return waking_non_zero_trylock(sem);
  116. }