gnat_riscv64_elf_13.2.1_938f208c/riscv64-elf/lib/gnat/light-tasking-polarfiresoc/gnarl/s-bbcpsp.adb

  1
  2
  3
  4
  5
  6
  7
  8
  9
 10
 11
 12
 13
 14
 15
 16
 17
 18
 19
 20
 21
 22
 23
 24
 25
 26
 27
 28
 29
 30
 31
 32
 33
 34
 35
 36
 37
 38
 39
 40
 41
 42
 43
 44
 45
 46
 47
 48
 49
 50
 51
 52
 53
 54
 55
 56
 57
 58
 59
 60
 61
 62
 63
 64
 65
 66
 67
 68
 69
 70
 71
 72
 73
 74
 75
 76
 77
 78
 79
 80
 81
 82
 83
 84
 85
 86
 87
 88
 89
 90
 91
 92
 93
 94
 95
 96
 97
 98
 99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
------------------------------------------------------------------------------
--                                                                          --
--                  GNAT RUN-TIME LIBRARY (GNARL) COMPONENTS                --
--                                                                          --
--               S Y S T E M . B B . C P U _ S P E C I F I C                --
--                                                                          --
--                                  B o d y                                 --
--                                                                          --
--        Copyright (C) 1999-2002 Universidad Politecnica de Madrid         --
--             Copyright (C) 2003-2005 The European Space Agency            --
--                     Copyright (C) 2003-2021, AdaCore                     --
--                                                                          --
-- GNAT is free software;  you can  redistribute it  and/or modify it under --
-- terms of the  GNU General Public License as published  by the Free Soft- --
-- ware  Foundation;  either version 3,  or (at your option) any later ver- --
-- sion.  GNAT is distributed in the hope that it will be useful, but WITH- --
-- OUT ANY WARRANTY;  without even the  implied warranty of MERCHANTABILITY --
-- or FITNESS FOR A PARTICULAR PURPOSE.                                     --
--                                                                          --
-- As a special exception under Section 7 of GPL version 3, you are granted --
-- additional permissions described in the GCC Runtime Library Exception,   --
-- version 3.1, as published by the Free Software Foundation.               --
--                                                                          --
-- You should have received a copy of the GNU General Public License and    --
-- a copy of the GCC Runtime Library Exception along with this program;     --
-- see the files COPYING3 and COPYING.RUNTIME respectively.  If not, see    --
-- <http://www.gnu.org/licenses/>.                                          --
--                                                                          --
-- GNAT was originally developed  by the GNAT team at  New York University. --
-- Extensive contributions were provided by Ada Core Technologies Inc.      --
------------------------------------------------------------------------------

--  This package implements RISC-V architecture specific support for the GNAT
--  Ravenscar run time.

with System.Machine_Code; use System.Machine_Code;

package body System.BB.CPU_Specific is

   use type BB.Interrupts.Interrupt_Handler;

   Handlers : array (Trap_Type) of BB.Interrupts.Interrupt_Handler :=
     (others => null);

   procedure Trap_Entry_Asm;
   pragma Import (Asm, Trap_Entry_Asm, "__gnat_trap_entry");

   procedure Trap_Handler (A0, A1, A2, A3, A4, A5, A6, A7 : Register_Word);
   pragma Export (Asm, Trap_Handler, "__gnat_trap_handler");
   --  The arguments A0-7 correspond to the a0-7 registers used for function
   --  arguments in the RISC-V ABI. These registers potentially hold a
   --  meaningful value in case of syscall or semihosting call.

   procedure Os_Exit;
   pragma Import (Ada, Os_Exit, "__gnat_exit");
   pragma No_Return (Os_Exit);

   ------------------
   -- Trap_Handler --
   ------------------

   procedure Trap_Handler (A0, A1, A2, A3, A4, A5, A6, A7 : Register_Word) is

      pragma Unreferenced (A0, A1, A2, A3, A4, A5, A6);

      Cause : constant Register_Word := Mcause;
      Code  : constant Register_Word := Cause and 16#0F#;
      Interrupt_Bit : constant Register_Word := 2**(Register_Word'Size - 1);
   begin

      if (Cause and Interrupt_Bit) /= 0 then

         --  The handlers requires an interrupt ID argument because they are
         --  of type BB.Interrupts.Interrupt_Handler, and they are of this
         --  type because one of them comes from
         --  System.BB.Board_Support.Time.Install_Alarm_Handler).
         --
         --  However there is no meaningful interrupt ID that we can give
         --  here because we are handling a trap, not an external interrupt.
         --  So we are arbitrarily using the first Interrupt_ID.

         case Code is

            when 7 => -- Machine Timer Interrupt
               if Handlers (Timer_Trap) /= null then
                  Handlers (Timer_Trap) (BB.Interrupts.Interrupt_ID'First);
               end if;

            when 11 => -- Machine External Interrupt
               if Handlers (External_Interrupt_Trap) /= null then
                  Handlers (External_Interrupt_Trap)
                    (BB.Interrupts.Interrupt_ID'First);
               end if;

            when others =>
               raise Program_Error with "Unhandled Interrupt Trap:" & Code'Img;
         end case;

      else
         case Code is
            when 11 => -- Environment call from M-mode

               case A7 is -- Syscall ID
                  when 93 => Os_Exit;
                  when others =>
                     raise Program_Error with "Unhandled syscall:" & A7'Img;
               end case;

            when others =>
               raise Program_Error with "Unhandled trap:" & Code'Img;
         end case;
      end if;
   end Trap_Handler;

   --------------------------
   -- Install_Trap_Handler --
   --------------------------

   procedure Install_Trap_Handler
     (Service_Routine : BB.Interrupts.Interrupt_Handler;
      Trap            : Trap_Type)
   is
   begin

      Handlers (Trap) := Service_Routine;

      case Trap is
         when Timer_Trap =>
            --  Enable the timer trap
            Set_Mie_Bits (Mie_MTIE);
         when External_Interrupt_Trap =>
            --  Enable the external interrupt trap
            Set_Mie_Bits (Mie_MEIE);
      end case;

      --  Set the Machine Trap-Vector address and use Direct mode
      Asm ("csrrw x0, mtvec, %0",
           Inputs   => Address'Asm_Input ("r",
                                          Trap_Entry_Asm'Address),
           Volatile => True);

   end Install_Trap_Handler;

   --------------
   -- Read_CSR --
   --------------

   function Read_CSR return Register_Word is
      Val : Register_Word;
   begin
      Asm ("csrr %0, " & Register_Name,
           Outputs  => Register_Word'Asm_Output ("=r", Val),
           Volatile => True);
      return Val;
   end Read_CSR;

   --------------------
   -- Clear_CSR_Bits --
   --------------------

   procedure Clear_CSR_Bits (Bits : Register_Word) is
      Unused : Register_Word;
   begin
      Asm ("csrrc %0, " & Register_Name & ", %1",
           Outputs  => Register_Word'Asm_Output ("=r", Unused),
           Inputs   => Register_Word'Asm_Input ("r", Bits),
           Volatile => True);
   end Clear_CSR_Bits;

   ------------------
   -- Set_CSR_Bits --
   ------------------

   procedure Set_CSR_Bits (Bits : Register_Word) is
      Unused : Register_Word;
   begin
      Asm ("csrrs %0, " & Register_Name & ", %1",
           Outputs  => Register_Word'Asm_Output ("=r", Unused),
           Inputs   => Register_Word'Asm_Input ("r", Bits),
           Volatile => True);
   end Set_CSR_Bits;

end System.BB.CPU_Specific;