Andrew Walbran | 68a8c16 | 2022-03-07 15:38:42 +0000 | [diff] [blame] | 1 | // Copyright 2022, The Android Open Source Project |
| 2 | // |
| 3 | // Licensed under the Apache License, Version 2.0 (the "License"); |
| 4 | // you may not use this file except in compliance with the License. |
| 5 | // You may obtain a copy of the License at |
| 6 | // |
| 7 | // http://www.apache.org/licenses/LICENSE-2.0 |
| 8 | // |
| 9 | // Unless required by applicable law or agreed to in writing, software |
| 10 | // distributed under the License is distributed on an "AS IS" BASIS, |
| 11 | // WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. |
| 12 | // See the License for the specific language governing permissions and |
| 13 | // limitations under the License. |
| 14 | |
| 15 | //! pVM firmware. |
| 16 | |
| 17 | #![no_main] |
| 18 | #![no_std] |
| 19 | |
Pierre-Clément Tosi | 5bbfca5 | 2022-10-21 12:14:35 +0100 | [diff] [blame^] | 20 | mod entry; |
Andrew Walbran | dfb7337 | 2022-04-21 10:52:27 +0000 | [diff] [blame] | 21 | mod exceptions; |
Pierre-Clément Tosi | da4440a | 2022-08-22 18:06:32 +0100 | [diff] [blame] | 22 | mod helpers; |
| 23 | mod smccc; |
Andrew Walbran | 68a8c16 | 2022-03-07 15:38:42 +0000 | [diff] [blame] | 24 | |
Pierre-Clément Tosi | 263ffd5 | 2022-10-05 20:27:50 +0100 | [diff] [blame] | 25 | use core::fmt; |
Pierre-Clément Tosi | da4440a | 2022-08-22 18:06:32 +0100 | [diff] [blame] | 26 | use helpers::checked_page_of; |
Pierre-Clément Tosi | 5bbfca5 | 2022-10-21 12:14:35 +0100 | [diff] [blame^] | 27 | use log::{debug, info}; |
| 28 | use vmbase::console; |
Andrew Walbran | 68a8c16 | 2022-03-07 15:38:42 +0000 | [diff] [blame] | 29 | |
Pierre-Clément Tosi | 263ffd5 | 2022-10-05 20:27:50 +0100 | [diff] [blame] | 30 | #[derive(Debug, Clone)] |
Pierre-Clément Tosi | da4440a | 2022-08-22 18:06:32 +0100 | [diff] [blame] | 31 | enum Error { |
| 32 | /// Failed to configure the UART; no logs available. |
| 33 | FailedUartSetup, |
| 34 | } |
Pierre-Clément Tosi | 263ffd5 | 2022-10-05 20:27:50 +0100 | [diff] [blame] | 35 | |
| 36 | impl fmt::Display for Error { |
| 37 | fn fmt(&self, f: &mut fmt::Formatter) -> fmt::Result { |
Pierre-Clément Tosi | 263ffd5 | 2022-10-05 20:27:50 +0100 | [diff] [blame] | 38 | let msg = match self { |
Pierre-Clément Tosi | da4440a | 2022-08-22 18:06:32 +0100 | [diff] [blame] | 39 | Self::FailedUartSetup => "Failed to configure the UART", |
Pierre-Clément Tosi | 263ffd5 | 2022-10-05 20:27:50 +0100 | [diff] [blame] | 40 | }; |
| 41 | write!(f, "{}", msg) |
| 42 | } |
| 43 | } |
| 44 | |
Pierre-Clément Tosi | 5bbfca5 | 2022-10-21 12:14:35 +0100 | [diff] [blame^] | 45 | fn main(fdt: &mut [u8], payload: &[u8]) -> Result<(), Error> { |
Pierre-Clément Tosi | da4440a | 2022-08-22 18:06:32 +0100 | [diff] [blame] | 46 | // We need to inform the hypervisor that the MMIO page containing the UART may be shared back. |
Pierre-Clément Tosi | da4440a | 2022-08-22 18:06:32 +0100 | [diff] [blame] | 47 | let mmio_granule = smccc::mmio_guard_info().map_err(|_| Error::FailedUartSetup)?; |
Pierre-Clément Tosi | 446136e | 2022-10-19 10:10:42 +0100 | [diff] [blame] | 48 | let uart_page = checked_page_of(console::BASE_ADDRESS, mmio_granule as usize) |
| 49 | .ok_or(Error::FailedUartSetup)?; |
| 50 | smccc::mmio_guard_map(uart_page as u64).map_err(|_| Error::FailedUartSetup)?; |
Pierre-Clément Tosi | da4440a | 2022-08-22 18:06:32 +0100 | [diff] [blame] | 51 | |
Pierre-Clément Tosi | 37105a6 | 2022-10-18 12:21:48 +0100 | [diff] [blame] | 52 | info!("pVM firmware"); |
| 53 | debug!( |
Pierre-Clément Tosi | 5bbfca5 | 2022-10-21 12:14:35 +0100 | [diff] [blame^] | 54 | "fdt_address={:#018x}, payload_start={:#018x}, payload_size={:#018x}", |
| 55 | fdt.as_ptr() as usize, |
| 56 | payload.as_ptr() as usize, |
| 57 | payload.len(), |
Andrew Walbran | e03395a | 2022-04-29 15:15:49 +0000 | [diff] [blame] | 58 | ); |
Andrew Walbran | 5db3235 | 2022-05-06 13:58:11 +0000 | [diff] [blame] | 59 | |
Pierre-Clément Tosi | 37105a6 | 2022-10-18 12:21:48 +0100 | [diff] [blame] | 60 | info!("Starting payload..."); |
Pierre-Clément Tosi | 263ffd5 | 2022-10-05 20:27:50 +0100 | [diff] [blame] | 61 | |
| 62 | Ok(()) |
| 63 | } |
| 64 | |
Pierre-Clément Tosi | 263ffd5 | 2022-10-05 20:27:50 +0100 | [diff] [blame] | 65 | fn jump_to_payload(fdt_address: u64, payload_start: u64) { |
Andrew Walbran | 5db3235 | 2022-05-06 13:58:11 +0000 | [diff] [blame] | 66 | // Safe because this is a function we have implemented in assembly that matches its signature |
| 67 | // here. |
| 68 | unsafe { |
| 69 | start_payload(fdt_address, payload_start); |
| 70 | } |
| 71 | } |
| 72 | |
| 73 | extern "C" { |
| 74 | fn start_payload(fdt_address: u64, payload_start: u64) -> !; |
Andrew Walbran | 68a8c16 | 2022-03-07 15:38:42 +0000 | [diff] [blame] | 75 | } |