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,
  28. struct sbi_trap_regs *regs,
  29. struct sbi_scratch *scratch)
  30. {
  31. int ret = SBI_ENOTSUPP;
  32. struct sbi_tlb_info tlb_info;
  33. switch (regs->a7) {
  34. case SBI_ECALL_SET_TIMER:
  35. #if __riscv_xlen == 32
  36. sbi_timer_event_start(scratch,
  37. (((u64)regs->a1 << 32) | (u64)regs->a0));
  38. #else
  39. sbi_timer_event_start(scratch, (u64)regs->a0);
  40. #endif
  41. ret = 0;
  42. break;
  43. case SBI_ECALL_CONSOLE_PUTCHAR:
  44. sbi_putc(regs->a0);
  45. ret = 0;
  46. break;
  47. case SBI_ECALL_CONSOLE_GETCHAR:
  48. regs->a0 = sbi_getc();
  49. ret = 0;
  50. break;
  51. case SBI_ECALL_CLEAR_IPI:
  52. sbi_ipi_clear_smode(scratch);
  53. ret = 0;
  54. break;
  55. case SBI_ECALL_SEND_IPI:
  56. ret = sbi_ipi_send_many(scratch, (ulong *)regs->a0,
  57. SBI_IPI_EVENT_SOFT, NULL);
  58. break;
  59. case SBI_ECALL_REMOTE_FENCE_I:
  60. ret = sbi_ipi_send_many(scratch, (ulong *)regs->a0,
  61. SBI_IPI_EVENT_FENCE_I, NULL);
  62. break;
  63. case SBI_ECALL_REMOTE_SFENCE_VMA:
  64. tlb_info.start = (unsigned long)regs->a1;
  65. tlb_info.size = (unsigned long)regs->a2;
  66. tlb_info.type = SBI_TLB_FLUSH_VMA;
  67. ret = sbi_ipi_send_many(scratch, (ulong *)regs->a0,
  68. SBI_IPI_EVENT_SFENCE_VMA, &tlb_info);
  69. break;
  70. case SBI_ECALL_REMOTE_SFENCE_VMA_ASID:
  71. tlb_info.start = (unsigned long)regs->a1;
  72. tlb_info.size = (unsigned long)regs->a2;
  73. tlb_info.asid = (unsigned long)regs->a3;
  74. tlb_info.type = SBI_TLB_FLUSH_VMA_ASID;
  75. ret = sbi_ipi_send_many(scratch, (ulong *)regs->a0,
  76. SBI_IPI_EVENT_SFENCE_VMA_ASID, &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. }