irqflags.h 1.7 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109
  1. #ifndef _ASM_SCORE_IRQFLAGS_H
  2. #define _ASM_SCORE_IRQFLAGS_H
  3. #ifndef __ASSEMBLY__
  4. #define raw_local_irq_save(x) \
  5. { \
  6. __asm__ __volatile__( \
  7. "mfcr r8, cr0;" \
  8. "li r9, 0xfffffffe;" \
  9. "nop;" \
  10. "mv %0, r8;" \
  11. "and r8, r8, r9;" \
  12. "mtcr r8, cr0;" \
  13. "nop;" \
  14. "nop;" \
  15. "nop;" \
  16. "nop;" \
  17. "nop;" \
  18. : "=r" (x) \
  19. : \
  20. : "r8", "r9" \
  21. ); \
  22. }
  23. #define raw_local_irq_restore(x) \
  24. { \
  25. __asm__ __volatile__( \
  26. "mfcr r8, cr0;" \
  27. "ldi r9, 0x1;" \
  28. "and %0, %0, r9;" \
  29. "or r8, r8, %0;" \
  30. "mtcr r8, cr0;" \
  31. "nop;" \
  32. "nop;" \
  33. "nop;" \
  34. "nop;" \
  35. "nop;" \
  36. : \
  37. : "r"(x) \
  38. : "r8", "r9" \
  39. ); \
  40. }
  41. #define raw_local_irq_enable(void) \
  42. { \
  43. __asm__ __volatile__( \
  44. "mfcr\tr8,cr0;" \
  45. "nop;" \
  46. "nop;" \
  47. "ori\tr8,0x1;" \
  48. "mtcr\tr8,cr0;" \
  49. "nop;" \
  50. "nop;" \
  51. "nop;" \
  52. "nop;" \
  53. "nop;" \
  54. : \
  55. : \
  56. : "r8"); \
  57. }
  58. #define raw_local_irq_disable(void) \
  59. { \
  60. __asm__ __volatile__( \
  61. "mfcr\tr8,cr0;" \
  62. "nop;" \
  63. "nop;" \
  64. "srli\tr8,r8,1;" \
  65. "slli\tr8,r8,1;" \
  66. "mtcr\tr8,cr0;" \
  67. "nop;" \
  68. "nop;" \
  69. "nop;" \
  70. "nop;" \
  71. "nop;" \
  72. : \
  73. : \
  74. : "r8"); \
  75. }
  76. #define raw_local_save_flags(x) \
  77. { \
  78. __asm__ __volatile__( \
  79. "mfcr r8, cr0;" \
  80. "nop;" \
  81. "nop;" \
  82. "mv %0, r8;" \
  83. "nop;" \
  84. "nop;" \
  85. "nop;" \
  86. "nop;" \
  87. "nop;" \
  88. "ldi r9, 0x1;" \
  89. "and %0, %0, r9;" \
  90. : "=r" (x) \
  91. : \
  92. : "r8", "r9" \
  93. ); \
  94. }
  95. static inline int raw_irqs_disabled_flags(unsigned long flags)
  96. {
  97. return !(flags & 1);
  98. }
  99. #endif
  100. #endif /* _ASM_SCORE_IRQFLAGS_H */