123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168 |
- #pragma once
- #include <common/glib.h>
- #include <process/preempt.h>
- typedef struct
- {
- __volatile__ char lock;
- } spinlock_t;
- void spin_init(spinlock_t *lock)
- {
- lock->lock = 1;
- }
- void spin_lock(spinlock_t *lock)
- {
- __asm__ __volatile__("1: \n\t"
- "lock decq %0 \n\t"
- "jns 3f \n\t"
- "2: \n\t"
- "pause \n\t"
- "cmpq $0, %0 \n\t"
- "jle 2b \n\t"
- "jmp 1b \n\t"
- "3:"
- : "=m"(lock->lock)::"memory");
- preempt_disable();
- }
- void spin_unlock(spinlock_t *lock)
- {
- preempt_enable();
- __asm__ __volatile__("movq $1, %0 \n\t"
- : "=m"(lock->lock)::"memory");
- }
- void spin_lock_no_preempt(spinlock_t *lock)
- {
- __asm__ __volatile__("1: \n\t"
- "lock decq %0 \n\t"
- "jns 3f \n\t"
- "2: \n\t"
- "pause \n\t"
- "cmpq $0, %0 \n\t"
- "jle 2b \n\t"
- "jmp 1b \n\t"
- "3:"
- : "=m"(lock->lock)::"memory");
- }
- void spin_unlock_no_preempt(spinlock_t * lock)
- {
- __asm__ __volatile__("movq $1, %0 \n\t"
- : "=m"(lock->lock)::"memory");
- }
- long spin_trylock(spinlock_t *lock)
- {
- uint64_t tmp_val = 0;
- preempt_disable();
-
- asm volatile("lock xchgq %0, %1 \n\t"
- : "=q"(tmp_val), "=m"(lock->lock)
- : "0"(0)
- : "memory");
- if (!tmp_val)
- preempt_enable();
- return tmp_val;
- }
- #define local_irq_save(x) __asm__ __volatile__("pushfq ; popq %0 ; cli" \
- : "=g"(x)::"memory")
- #define local_irq_restore(x) __asm__ __volatile__("pushq %0 ; popfq" ::"g"(x) \
- : "memory")
- #define local_irq_disable() cli();
- #define local_irq_enable() sti();
- #define spin_lock_irqsave(lock, flags) \
- do \
- { \
- local_irq_save(flags); \
- spin_lock(lock); \
- } while (0)
- #define spin_unlock_irqrestore(lock, flags) \
- do \
- { \
- spin_unlock(lock); \
- local_irq_restore(flags); \
- } while (0)
- #define spin_lock_irq(lock) \
- do \
- { \
- local_irq_disable(); \
- spin_lock(lock); \
- } while (0)
- #define spin_unlock_irq(lock) \
- do \
- { \
- spin_unlock(lock); \
- local_irq_enable(); \
- } while (0)
|