Lock.cpp 1.6 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970
  1. #include <Kernel/Lock.h>
  2. void Lock::lock()
  3. {
  4. if (!are_interrupts_enabled()) {
  5. kprintf("Interrupts disabled when trying to take Lock{%s}\n", m_name);
  6. dump_backtrace();
  7. hang();
  8. }
  9. ASSERT(!Scheduler::is_active());
  10. for (;;) {
  11. if (CAS(&m_lock, 1, 0) == 0) {
  12. if (!m_holder || m_holder == current) {
  13. m_holder = current;
  14. ++m_level;
  15. memory_barrier();
  16. m_lock = 0;
  17. return;
  18. }
  19. m_lock = 0;
  20. }
  21. Scheduler::donate_to(m_holder, m_name);
  22. }
  23. }
  24. void Lock::unlock()
  25. {
  26. for (;;) {
  27. if (CAS(&m_lock, 1, 0) == 0) {
  28. ASSERT(m_holder == current);
  29. ASSERT(m_level);
  30. --m_level;
  31. if (m_level) {
  32. memory_barrier();
  33. m_lock = 0;
  34. return;
  35. }
  36. m_holder = nullptr;
  37. memory_barrier();
  38. m_lock = 0;
  39. return;
  40. }
  41. Scheduler::donate_to(m_holder, m_name);
  42. }
  43. }
  44. bool Lock::unlock_if_locked()
  45. {
  46. for (;;) {
  47. if (CAS(&m_lock, 1, 0) == 0) {
  48. if (m_level == 0) {
  49. memory_barrier();
  50. m_lock = 0;
  51. return false;
  52. }
  53. ASSERT(m_holder == current);
  54. ASSERT(m_level);
  55. --m_level;
  56. if (m_level) {
  57. memory_barrier();
  58. m_lock = 0;
  59. return false;
  60. }
  61. m_holder = nullptr;
  62. memory_barrier();
  63. m_lock = 0;
  64. return true;
  65. }
  66. }
  67. }