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 | |
Andrew Walbran | dfb7337 | 2022-04-21 10:52:27 +0000 | [diff] [blame] | 20 | mod exceptions; |
Pierre-Clément Tosi | da4440a | 2022-08-22 18:06:32 +0100 | [diff] [blame^] | 21 | mod helpers; |
| 22 | mod smccc; |
Andrew Walbran | 68a8c16 | 2022-03-07 15:38:42 +0000 | [diff] [blame] | 23 | |
Pierre-Clément Tosi | 263ffd5 | 2022-10-05 20:27:50 +0100 | [diff] [blame] | 24 | use core::fmt; |
Pierre-Clément Tosi | da4440a | 2022-08-22 18:06:32 +0100 | [diff] [blame^] | 25 | use helpers::checked_page_of; |
Andrew Walbran | b996b4a | 2022-04-22 15:15:41 +0000 | [diff] [blame] | 26 | |
Pierre-Clément Tosi | da4440a | 2022-08-22 18:06:32 +0100 | [diff] [blame^] | 27 | use vmbase::{console, main, power::reboot, println}; |
Andrew Walbran | 68a8c16 | 2022-03-07 15:38:42 +0000 | [diff] [blame] | 28 | |
Pierre-Clément Tosi | 263ffd5 | 2022-10-05 20:27:50 +0100 | [diff] [blame] | 29 | #[derive(Debug, Clone)] |
Pierre-Clément Tosi | da4440a | 2022-08-22 18:06:32 +0100 | [diff] [blame^] | 30 | enum Error { |
| 31 | /// Failed to configure the UART; no logs available. |
| 32 | FailedUartSetup, |
| 33 | } |
Pierre-Clément Tosi | 263ffd5 | 2022-10-05 20:27:50 +0100 | [diff] [blame] | 34 | |
| 35 | impl fmt::Display for Error { |
| 36 | fn fmt(&self, f: &mut fmt::Formatter) -> fmt::Result { |
Pierre-Clément Tosi | 263ffd5 | 2022-10-05 20:27:50 +0100 | [diff] [blame] | 37 | let msg = match self { |
Pierre-Clément Tosi | da4440a | 2022-08-22 18:06:32 +0100 | [diff] [blame^] | 38 | Self::FailedUartSetup => "Failed to configure the UART", |
Pierre-Clément Tosi | 263ffd5 | 2022-10-05 20:27:50 +0100 | [diff] [blame] | 39 | }; |
| 40 | write!(f, "{}", msg) |
| 41 | } |
| 42 | } |
| 43 | |
| 44 | fn main(fdt_address: u64, payload_start: u64, payload_size: u64, arg3: u64) -> Result<(), Error> { |
Pierre-Clément Tosi | da4440a | 2022-08-22 18:06:32 +0100 | [diff] [blame^] | 45 | // We need to inform the hypervisor that the MMIO page containing the UART may be shared back. |
| 46 | let uart = console::BASE_ADDRESS as u64; |
| 47 | let mmio_granule = smccc::mmio_guard_info().map_err(|_| Error::FailedUartSetup)?; |
| 48 | let uart_page = checked_page_of(uart, mmio_granule).ok_or(Error::FailedUartSetup)?; |
| 49 | smccc::mmio_guard_map(uart_page).map_err(|_| Error::FailedUartSetup)?; |
| 50 | |
Andrew Walbran | e03395a | 2022-04-29 15:15:49 +0000 | [diff] [blame] | 51 | println!("pVM firmware"); |
| 52 | println!( |
Andrew Walbran | f17c651 | 2022-06-28 15:52:23 +0000 | [diff] [blame] | 53 | "fdt_address={:#018x}, payload_start={:#018x}, payload_size={:#018x}, x3={:#018x}", |
Andrew Walbran | e03395a | 2022-04-29 15:15:49 +0000 | [diff] [blame] | 54 | fdt_address, payload_start, payload_size, arg3, |
| 55 | ); |
Andrew Walbran | 5db3235 | 2022-05-06 13:58:11 +0000 | [diff] [blame] | 56 | |
| 57 | println!("Starting payload..."); |
Pierre-Clément Tosi | 263ffd5 | 2022-10-05 20:27:50 +0100 | [diff] [blame] | 58 | |
| 59 | Ok(()) |
| 60 | } |
| 61 | |
| 62 | main!(main_wrapper); |
| 63 | |
| 64 | /// Entry point for pVM firmware. |
| 65 | pub fn main_wrapper(fdt_address: u64, payload_start: u64, payload_size: u64, arg3: u64) { |
| 66 | match main(fdt_address, payload_start, payload_size, arg3) { |
| 67 | Ok(()) => jump_to_payload(fdt_address, payload_start), |
| 68 | Err(e) => { |
| 69 | println!("Boot rejected: {}", e); |
| 70 | } |
| 71 | } |
| 72 | reboot() |
| 73 | } |
| 74 | |
| 75 | fn jump_to_payload(fdt_address: u64, payload_start: u64) { |
Andrew Walbran | 5db3235 | 2022-05-06 13:58:11 +0000 | [diff] [blame] | 76 | // Safe because this is a function we have implemented in assembly that matches its signature |
| 77 | // here. |
| 78 | unsafe { |
| 79 | start_payload(fdt_address, payload_start); |
| 80 | } |
| 81 | } |
| 82 | |
| 83 | extern "C" { |
| 84 | fn start_payload(fdt_address: u64, payload_start: u64) -> !; |
Andrew Walbran | 68a8c16 | 2022-03-07 15:38:42 +0000 | [diff] [blame] | 85 | } |