sbi_ecall.c 2.2 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101
  1. /*
  2. * SPDX-License-Identifier: BSD-2-Clause
  3. *
  4. * Copyright (c) 2019 Western Digital Corporation or its affiliates.
  5. *
  6. * Authors:
  7. * Anup Patel <anup.patel@wdc.com>
  8. */
  9. #include <sbi/sbi_console.h>
  10. #include <sbi/sbi_ecall.h>
  11. #include <sbi/sbi_ecall_interface.h>
  12. #include <sbi/sbi_error.h>
  13. #include <sbi/sbi_ipi.h>
  14. #include <sbi/sbi_system.h>
  15. #include <sbi/sbi_timer.h>
  16. #include <sbi/sbi_trap.h>
  17. #define SBI_ECALL_VERSION_MAJOR 0
  18. #define SBI_ECALL_VERSION_MINOR 1
  19. u16 sbi_ecall_version_major(void)
  20. {
  21. return SBI_ECALL_VERSION_MAJOR;
  22. }
  23. u16 sbi_ecall_version_minor(void)
  24. {
  25. return SBI_ECALL_VERSION_MINOR;
  26. }
  27. int sbi_ecall_handler(u32 hartid, ulong mcause, struct sbi_trap_regs *regs,
  28. struct sbi_scratch *scratch)
  29. {
  30. int ret = SBI_ENOTSUPP;
  31. struct sbi_tlb_info tlb_info;
  32. switch (regs->a7) {
  33. case SBI_ECALL_SET_TIMER:
  34. #if __riscv_xlen == 32
  35. sbi_timer_event_start(scratch,
  36. (((u64)regs->a1 << 32) | (u64)regs->a0));
  37. #else
  38. sbi_timer_event_start(scratch, (u64)regs->a0);
  39. #endif
  40. ret = 0;
  41. break;
  42. case SBI_ECALL_CONSOLE_PUTCHAR:
  43. sbi_putc(regs->a0);
  44. ret = 0;
  45. break;
  46. case SBI_ECALL_CONSOLE_GETCHAR:
  47. regs->a0 = sbi_getc();
  48. ret = 0;
  49. break;
  50. case SBI_ECALL_CLEAR_IPI:
  51. sbi_ipi_clear_smode(scratch);
  52. ret = 0;
  53. break;
  54. case SBI_ECALL_SEND_IPI:
  55. ret = sbi_ipi_send_many(scratch, (ulong *)regs->a0,
  56. SBI_IPI_EVENT_SOFT, NULL);
  57. break;
  58. case SBI_ECALL_REMOTE_FENCE_I:
  59. ret = sbi_ipi_send_many(scratch, (ulong *)regs->a0,
  60. SBI_IPI_EVENT_FENCE_I, NULL);
  61. break;
  62. case SBI_ECALL_REMOTE_SFENCE_VMA:
  63. tlb_info.start = (unsigned long)regs->a1;
  64. tlb_info.size = (unsigned long)regs->a2;
  65. tlb_info.type = SBI_TLB_FLUSH_VMA;
  66. ret = sbi_ipi_send_many(scratch, (ulong *)regs->a0,
  67. SBI_IPI_EVENT_SFENCE_VMA, &tlb_info);
  68. break;
  69. case SBI_ECALL_REMOTE_SFENCE_VMA_ASID:
  70. tlb_info.start = (unsigned long)regs->a1;
  71. tlb_info.size = (unsigned long)regs->a2;
  72. tlb_info.asid = (unsigned long)regs->a3;
  73. tlb_info.type = SBI_TLB_FLUSH_VMA_ASID;
  74. ret = sbi_ipi_send_many(scratch, (ulong *)regs->a0,
  75. SBI_IPI_EVENT_SFENCE_VMA_ASID,
  76. &tlb_info);
  77. break;
  78. case SBI_ECALL_SHUTDOWN:
  79. sbi_system_shutdown(scratch, 0);
  80. ret = 0;
  81. break;
  82. default:
  83. regs->a0 = SBI_ENOTSUPP;
  84. ret = 0;
  85. break;
  86. };
  87. if (!ret) {
  88. regs->mepc += 4;
  89. }
  90. return ret;
  91. }