sbi_ecall_base.c 1.8 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879
  1. /*
  2. * SPDX-License-Identifier: BSD-2-Clause
  3. *
  4. * Copyright (c) 2020 Western Digital Corporation or its affiliates.
  5. *
  6. * Authors:
  7. * Anup Patel <anup.patel@wdc.com>
  8. * Atish Patra <atish.patra@wdc.com>
  9. */
  10. #include <sbi/sbi_ecall.h>
  11. #include <sbi/sbi_ecall_interface.h>
  12. #include <sbi/sbi_error.h>
  13. #include <sbi/sbi_trap.h>
  14. #include <sbi/sbi_version.h>
  15. #include <sbi/riscv_asm.h>
  16. static int sbi_ecall_base_probe(unsigned long extid, unsigned long *out_val)
  17. {
  18. struct sbi_ecall_extension *ext;
  19. ext = sbi_ecall_find_extension(extid);
  20. if (!ext) {
  21. *out_val = 0;
  22. return 0;
  23. }
  24. if (ext->probe)
  25. return ext->probe(extid, out_val);
  26. *out_val = 1;
  27. return 0;
  28. }
  29. static int sbi_ecall_base_handler(unsigned long extid, unsigned long funcid,
  30. const struct sbi_trap_regs *regs,
  31. unsigned long *out_val,
  32. struct sbi_trap_info *out_trap)
  33. {
  34. int ret = 0;
  35. switch (funcid) {
  36. case SBI_EXT_BASE_GET_SPEC_VERSION:
  37. *out_val = (SBI_ECALL_VERSION_MAJOR <<
  38. SBI_SPEC_VERSION_MAJOR_OFFSET) &
  39. (SBI_SPEC_VERSION_MAJOR_MASK <<
  40. SBI_SPEC_VERSION_MAJOR_OFFSET);
  41. *out_val = *out_val | SBI_ECALL_VERSION_MINOR;
  42. break;
  43. case SBI_EXT_BASE_GET_IMP_ID:
  44. *out_val = sbi_ecall_get_impid();
  45. break;
  46. case SBI_EXT_BASE_GET_IMP_VERSION:
  47. *out_val = OPENSBI_VERSION;
  48. break;
  49. case SBI_EXT_BASE_GET_MVENDORID:
  50. *out_val = csr_read(CSR_MVENDORID);
  51. break;
  52. case SBI_EXT_BASE_GET_MARCHID:
  53. *out_val = csr_read(CSR_MARCHID);
  54. break;
  55. case SBI_EXT_BASE_GET_MIMPID:
  56. *out_val = csr_read(CSR_MIMPID);
  57. break;
  58. case SBI_EXT_BASE_PROBE_EXT:
  59. ret = sbi_ecall_base_probe(regs->a0, out_val);
  60. break;
  61. default:
  62. ret = SBI_ENOTSUPP;
  63. }
  64. return ret;
  65. }
  66. struct sbi_ecall_extension ecall_base = {
  67. .extid_start = SBI_EXT_BASE,
  68. .extid_end = SBI_EXT_BASE,
  69. .handle = sbi_ecall_base_handler,
  70. };