blob: 24c36b3f3c67d869d14fae2c35b78f4fbed40843 [file] [log] [blame]
Andrew Walbran68a8c162022-03-07 15:38:42 +00001// 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]
Pierre-Clément Tosifc531152022-10-20 12:22:23 +010019#![feature(default_alloc_error_handler)]
Andrew Walbran68a8c162022-03-07 15:38:42 +000020
Pierre-Clément Tosidb74cb12022-12-08 13:56:25 +000021extern crate alloc;
22
Pierre-Clément Tosi4ef75222022-10-26 17:40:50 +010023mod avb;
Pierre-Clément Tosi20b60962022-10-17 13:35:27 +010024mod config;
Pierre-Clément Tosi4f4f5eb2022-12-08 14:31:42 +000025mod dice;
Pierre-Clément Tosi5bbfca52022-10-21 12:14:35 +010026mod entry;
Andrew Walbrandfb73372022-04-21 10:52:27 +000027mod exceptions;
Pierre-Clément Tosia0934c12022-11-25 20:54:11 +000028mod fdt;
Pierre-Clément Tosifc531152022-10-20 12:22:23 +010029mod heap;
Pierre-Clément Tosida4440a2022-08-22 18:06:32 +010030mod helpers;
Andrew Walbranba47d1d2022-12-14 15:21:44 +000031mod hvc;
Pierre-Clément Tosia0934c12022-11-25 20:54:11 +000032mod memory;
Pierre-Clément Tosi072969b2022-10-19 17:32:24 +010033mod mmio_guard;
Pierre-Clément Tosia8a4a202022-11-03 14:16:46 +000034mod mmu;
Pierre-Clément Tosida4440a2022-08-22 18:06:32 +010035mod smccc;
Andrew Walbran848decf2022-12-15 14:39:38 +000036mod virtio;
Andrew Walbran68a8c162022-03-07 15:38:42 +000037
Pierre-Clément Tosidb74cb12022-12-08 13:56:25 +000038use alloc::boxed::Box;
39
Andrew Walbrand1d03182022-12-09 18:20:01 +000040use crate::{
Pierre-Clément Tosi2d652982023-01-09 19:30:17 +000041 avb::PUBLIC_KEY,
Pierre-Clément Tosi4f4f5eb2022-12-08 14:31:42 +000042 dice::derive_next_bcc,
Andrew Walbrand1d03182022-12-09 18:20:01 +000043 entry::RebootReason,
Pierre-Clément Tosidb74cb12022-12-08 13:56:25 +000044 fdt::add_dice_node,
45 helpers::flush,
Pierre-Clément Tosi4f4f5eb2022-12-08 14:31:42 +000046 helpers::GUEST_PAGE_SIZE,
Andrew Walbrand1d03182022-12-09 18:20:01 +000047 memory::MemoryTracker,
Andrew Walbranb398fc82023-01-24 14:45:46 +000048 virtio::pci::{self, find_virtio_devices},
Andrew Walbrand1d03182022-12-09 18:20:01 +000049};
Pierre-Clément Tosi4f4f5eb2022-12-08 14:31:42 +000050use ::dice::bcc;
Andrew Walbran730375d2022-12-21 14:04:34 +000051use fdtpci::{PciError, PciInfo};
Andrew Walbran19690632022-12-07 16:41:30 +000052use libfdt::Fdt;
Pierre-Clément Tosi8edf72e2022-12-06 16:02:57 +000053use log::{debug, error, info, trace};
Pierre-Clément Tosi2d652982023-01-09 19:30:17 +000054use pvmfw_avb::verify_payload;
Andrew Walbran68a8c162022-03-07 15:38:42 +000055
Pierre-Clément Tosi4f4f5eb2022-12-08 14:31:42 +000056const NEXT_BCC_SIZE: usize = GUEST_PAGE_SIZE;
57
Alice Wang28cbcf12022-12-01 07:58:28 +000058fn main(
Pierre-Clément Tosidb74cb12022-12-08 13:56:25 +000059 fdt: &mut Fdt,
Alice Wang28cbcf12022-12-01 07:58:28 +000060 signed_kernel: &[u8],
61 ramdisk: Option<&[u8]>,
Pierre-Clément Tosi8edf72e2022-12-06 16:02:57 +000062 bcc: &bcc::Handover,
Andrew Walbran19690632022-12-07 16:41:30 +000063 memory: &mut MemoryTracker,
Alice Wang0a688d22022-12-02 09:48:41 +000064) -> Result<(), RebootReason> {
Pierre-Clément Tosi37105a62022-10-18 12:21:48 +010065 info!("pVM firmware");
Pierre-Clément Tosia0934c12022-11-25 20:54:11 +000066 debug!("FDT: {:?}", fdt as *const libfdt::Fdt);
67 debug!("Signed kernel: {:?} ({:#x} bytes)", signed_kernel.as_ptr(), signed_kernel.len());
Alice Wanga78279c2022-12-16 12:41:19 +000068 debug!("AVB public key: addr={:?}, size={:#x} ({1})", PUBLIC_KEY.as_ptr(), PUBLIC_KEY.len());
Pierre-Clément Tosia0934c12022-11-25 20:54:11 +000069 if let Some(rd) = ramdisk {
70 debug!("Ramdisk: {:?} ({:#x} bytes)", rd.as_ptr(), rd.len());
71 } else {
72 debug!("Ramdisk: None");
73 }
Pierre-Clément Tosi8edf72e2022-12-06 16:02:57 +000074 trace!("BCC: {bcc:x?}");
Andrew Walbran19690632022-12-07 16:41:30 +000075
76 // Set up PCI bus for VirtIO devices.
Andrew Walbrand1d03182022-12-09 18:20:01 +000077 let pci_info = PciInfo::from_fdt(fdt).map_err(handle_pci_error)?;
78 debug!("PCI: {:#x?}", pci_info);
Andrew Walbranb398fc82023-01-24 14:45:46 +000079 let mut pci_root = pci::initialise(pci_info, memory)?;
Andrew Walbran0a8dac72022-12-21 13:49:06 +000080 find_virtio_devices(&mut pci_root).map_err(handle_pci_error)?;
Andrew Walbran19690632022-12-07 16:41:30 +000081
Alice Wang6b486f12023-01-06 13:12:16 +000082 verify_payload(signed_kernel, ramdisk, PUBLIC_KEY).map_err(|e| {
Pierre-Clément Tosi2d652982023-01-09 19:30:17 +000083 error!("Failed to verify the payload: {e}");
84 RebootReason::PayloadVerificationError
85 })?;
86
Pierre-Clément Tosi4f4f5eb2022-12-08 14:31:42 +000087 let debug_mode = false; // TODO(b/256148034): Derive the DICE mode from the received initrd.
88 const HASH_SIZE: usize = 64;
89 let mut hashes = [0; HASH_SIZE * 2]; // TODO(b/256148034): Extract AvbHashDescriptor digests.
90 hashes[..HASH_SIZE].copy_from_slice(&::dice::hash(signed_kernel).map_err(|_| {
91 error!("Failed to hash the kernel");
92 RebootReason::InternalError
93 })?);
94 // Note: Using signed_kernel currently makes the DICE code input depend on its VBMeta fields.
95 let code_hash = if let Some(rd) = ramdisk {
96 hashes[HASH_SIZE..].copy_from_slice(&::dice::hash(rd).map_err(|_| {
97 error!("Failed to hash the ramdisk");
98 RebootReason::InternalError
99 })?);
100 &hashes[..]
101 } else {
102 &hashes[..HASH_SIZE]
103 };
Pierre-Clément Tosidb74cb12022-12-08 13:56:25 +0000104 let next_bcc = heap::aligned_boxed_slice(NEXT_BCC_SIZE, GUEST_PAGE_SIZE).ok_or_else(|| {
105 error!("Failed to allocate the next-stage BCC");
106 RebootReason::InternalError
107 })?;
108 // By leaking the slice, its content will be left behind for the next stage.
109 let next_bcc = Box::leak(next_bcc);
Pierre-Clément Tosi4f4f5eb2022-12-08 14:31:42 +0000110 let next_bcc_size =
111 derive_next_bcc(bcc, next_bcc, code_hash, debug_mode, PUBLIC_KEY).map_err(|e| {
112 error!("Failed to derive next-stage DICE secrets: {e:?}");
113 RebootReason::SecretDerivationError
114 })?;
115 trace!("Next BCC: {:x?}", bcc::Handover::new(&next_bcc[..next_bcc_size]));
116
Pierre-Clément Tosidb74cb12022-12-08 13:56:25 +0000117 flush(next_bcc);
118
119 add_dice_node(fdt, next_bcc.as_ptr() as usize, NEXT_BCC_SIZE).map_err(|e| {
120 error!("Failed to add DICE node to device tree: {e}");
121 RebootReason::InternalError
122 })?;
123
Alice Wang4379c832022-12-05 15:50:20 +0000124 info!("Starting payload...");
Alice Wang28cbcf12022-12-01 07:58:28 +0000125 Ok(())
Pierre-Clément Tosi263ffd52022-10-05 20:27:50 +0100126}
Andrew Walbrand1d03182022-12-09 18:20:01 +0000127
128/// Logs the given PCI error and returns the appropriate `RebootReason`.
129fn handle_pci_error(e: PciError) -> RebootReason {
130 error!("{}", e);
131 match e {
132 PciError::FdtErrorPci(_)
133 | PciError::FdtNoPci
134 | PciError::FdtErrorReg(_)
135 | PciError::FdtMissingReg
136 | PciError::FdtRegEmpty
137 | PciError::FdtRegMissingSize
138 | PciError::CamWrongSize(_)
139 | PciError::FdtErrorRanges(_)
140 | PciError::FdtMissingRanges
141 | PciError::RangeAddressMismatch { .. }
142 | PciError::NoSuitableRange => RebootReason::InvalidFdt,
Andrew Walbrand1d03182022-12-09 18:20:01 +0000143 }
144}