kryo-l2-accessors.c 1.5 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657
  1. // SPDX-License-Identifier: GPL-2.0
  2. /*
  3. * Copyright (c) 2018, The Linux Foundation. All rights reserved.
  4. */
  5. #include <linux/spinlock.h>
  6. #include <asm/barrier.h>
  7. #include <asm/sysreg.h>
  8. #include <soc/qcom/kryo-l2-accessors.h>
  9. #define L2CPUSRSELR_EL1 sys_reg(3, 3, 15, 0, 6)
  10. #define L2CPUSRDR_EL1 sys_reg(3, 3, 15, 0, 7)
  11. static DEFINE_RAW_SPINLOCK(l2_access_lock);
  12. /**
  13. * kryo_l2_set_indirect_reg() - write value to an L2 register
  14. * @reg: Address of L2 register.
  15. * @value: Value to be written to register.
  16. *
  17. * Use architecturally required barriers for ordering between system register
  18. * accesses, and system registers with respect to device memory
  19. */
  20. void kryo_l2_set_indirect_reg(u64 reg, u64 val)
  21. {
  22. unsigned long flags;
  23. raw_spin_lock_irqsave(&l2_access_lock, flags);
  24. write_sysreg_s(reg, L2CPUSRSELR_EL1);
  25. isb();
  26. write_sysreg_s(val, L2CPUSRDR_EL1);
  27. isb();
  28. raw_spin_unlock_irqrestore(&l2_access_lock, flags);
  29. }
  30. EXPORT_SYMBOL(kryo_l2_set_indirect_reg);
  31. /**
  32. * kryo_l2_get_indirect_reg() - read an L2 register value
  33. * @reg: Address of L2 register.
  34. *
  35. * Use architecturally required barriers for ordering between system register
  36. * accesses, and system registers with respect to device memory
  37. */
  38. u64 kryo_l2_get_indirect_reg(u64 reg)
  39. {
  40. u64 val;
  41. unsigned long flags;
  42. raw_spin_lock_irqsave(&l2_access_lock, flags);
  43. write_sysreg_s(reg, L2CPUSRSELR_EL1);
  44. isb();
  45. val = read_sysreg_s(L2CPUSRDR_EL1);
  46. raw_spin_unlock_irqrestore(&l2_access_lock, flags);
  47. return val;
  48. }
  49. EXPORT_SYMBOL(kryo_l2_get_indirect_reg);