Vboot Reference: Add functions to verify signed kernel images.

BUG=670
TEST=Adds kernel_image_test which tests the new functions.

The kernel image verification pretty much exactly mirror the already existing firmware image verification functions except with a few different/additional fields in a signed kernel image. The firmware signing key is the root key equivalent for kernel images.

This CL also moves the image verification tests to a different script. There's some additional cleanup of the code that I will be submitting separately after this and another pending patches get LGTMed and land.

Review URL: http://codereview.chromium.org/660161
diff --git a/utils/Makefile b/utils/Makefile
index e9b6b67..d0f8ea5 100644
--- a/utils/Makefile
+++ b/utils/Makefile
@@ -12,7 +12,7 @@
 FIRMWARELIBS = $(TOP)/crypto/libcrypto.a $(TOP)/common/libcommon.a
 
 all: dumpRSAPublicKey verify_data signature_digest firmware_utility \
-	file_keys.o firmware_image.o
+	file_keys.o firmware_image.o kernel_image.o
 
 dumpRSAPublicKey: dumpRSAPublicKey.c
 	$(CC) $(CFLAGS) $(LIBS) $< -o $@
@@ -34,7 +34,9 @@
 firmware_image.o: firmware_image.c
 	$(CC) $(CFLAGS) -ansi $(INCLUDES) -c $< -o $@
 
+kernel_image.o: kernel_image.c
+	$(CC) $(CFLAGS) -ansi $(INCLUDES) -c $< -o $@
 clean:
 	rm -f dumpRSAPublicKey verify_data signature_digest firmware_image.o \
-	file_keys.o firmware_utility
+	kernel_image.o file_keys.o firmware_utility
 
diff --git a/utils/kernel_image.c b/utils/kernel_image.c
new file mode 100644
index 0000000..8f874ec
--- /dev/null
+++ b/utils/kernel_image.c
@@ -0,0 +1,614 @@
+/* Copyright (c) 2010 The Chromium OS Authors. All rights reserved.
+ * Use of this source code is governed by a BSD-style license that can be
+ * found in the LICENSE file.
+ *
+ * Functions for generating and manipulating a verified boot kernel image.
+ */
+
+#include "kernel_image.h"
+
+#include <fcntl.h>
+#include <stdio.h>
+#include <sys/types.h>
+#include <sys/stat.h>
+#include <unistd.h>
+
+#include "file_keys.h"
+#include "padding.h"
+#include "rsa_utility.h"
+#include "sha_utility.h"
+#include "utility.h"
+
+/* Macro to determine the size of a field structure in the KernelImage
+ * structure. */
+#define FIELD_LEN(field) (sizeof(((KernelImage*)0)->field))
+
+KernelImage* KernelImageNew(void) {
+  KernelImage* image = (KernelImage*) Malloc(sizeof(KernelImage));
+  if (image) {
+    image->kernel_sign_key = NULL;
+    image->kernel_key_signature = NULL;
+    image->config_signature = NULL;
+    image->kernel_signature = NULL;
+    image->kernel_data = NULL;
+  }
+  return image;
+}
+
+void KernelImageFree(KernelImage* image) {
+  if (image) {
+    Free(image->kernel_sign_key);
+    Free(image->kernel_key_signature);
+    Free(image->config_signature);
+    Free(image->kernel_signature);
+    Free(image->kernel_data);
+    Free(image);
+  }
+}
+
+KernelImage* ReadKernelImage(const char* input_file) {
+  uint32_t file_size;
+  int image_len = 0;  /* Total size of the kernel image. */
+  int header_len = 0;
+  int firmware_sign_key_len;
+  int kernel_key_signature_len;
+  int kernel_sign_key_len;
+  int kernel_signature_len;
+  uint8_t* kernel_buf;
+  MemcpyState st;
+  KernelImage* image = KernelImageNew();
+
+  if (!image)
+    return NULL;
+
+  kernel_buf = BufferFromFile(input_file, &file_size);
+  image_len = file_size;
+
+  st.remaining_len = image_len;
+  st.remaining_buf = kernel_buf;
+
+  /* Read and compare magic bytes. */
+  if (!StatefulMemcpy(&st, &image->magic, KERNEL_MAGIC_SIZE))
+    goto parse_failure;
+
+  if (SafeMemcmp(image->magic, KERNEL_MAGIC, KERNEL_MAGIC_SIZE)) {
+    fprintf(stderr, "Wrong Kernel Magic.\n");
+    goto parse_failure;
+  }
+  StatefulMemcpy(&st, &image->header_version, FIELD_LEN(header_version));
+  StatefulMemcpy(&st, &image->header_len, FIELD_LEN(header_len));
+  StatefulMemcpy(&st, &image->firmware_sign_algorithm,
+                 FIELD_LEN(firmware_sign_algorithm));
+  StatefulMemcpy(&st, &image->kernel_sign_algorithm,
+                 FIELD_LEN(kernel_sign_algorithm));
+
+  /* Valid Kernel Key signing algorithm. */
+  if (image->firmware_sign_algorithm >= kNumAlgorithms)
+    goto parse_failure;
+
+  /* Valid Kernel Signing Algorithm? */
+  if (image->kernel_sign_algorithm >= kNumAlgorithms)
+    goto parse_failure;
+
+  /* Compute size of pre-processed RSA public keys and signatures. */
+  firmware_sign_key_len = RSAProcessedKeySize(image->firmware_sign_algorithm);
+  /* TODO(gauravsh): Make siglen_map track the signature length in number
+   * of bytes rather than 32-bit words. */
+  kernel_key_signature_len  = (siglen_map[image->firmware_sign_algorithm] *
+                               sizeof(uint32_t));
+  kernel_sign_key_len = RSAProcessedKeySize(image->kernel_sign_algorithm);
+  kernel_signature_len = (siglen_map[image->kernel_sign_algorithm] *
+                          sizeof(uint32_t));
+
+  /* Check whether key header length is correct. */
+  header_len = (FIELD_LEN(header_version) +
+                FIELD_LEN(header_len) +
+                FIELD_LEN(firmware_sign_algorithm) +
+                FIELD_LEN(kernel_sign_algorithm) +
+                FIELD_LEN(kernel_key_version) +
+                kernel_sign_key_len +
+                FIELD_LEN(header_checksum));
+
+  if (header_len != image->header_len) {
+    fprintf(stderr, "Header length mismatch. Got: %d, Expected: %d\n",
+            image->header_len, header_len);
+    goto parse_failure;
+  }
+
+  /* Read pre-processed public half of the kernel signing key. */
+  StatefulMemcpy(&st, &image->kernel_key_version,
+                 FIELD_LEN(kernel_key_version));
+  image->kernel_sign_key = (uint8_t*) Malloc(kernel_sign_key_len);
+  StatefulMemcpy(&st, image->kernel_sign_key, kernel_sign_key_len);
+  StatefulMemcpy(&st, image->header_checksum, FIELD_LEN(header_checksum));
+
+  /* Read key signature. */
+  StatefulMemcpy(&st, image->kernel_key_signature,
+                 FIELD_LEN(kernel_key_signature));
+
+  /* Read the kernel config. */
+  StatefulMemcpy(&st, &image->kernel_version, FIELD_LEN(kernel_version));
+  StatefulMemcpy(&st, &image->options.version, FIELD_LEN(options.version));
+  StatefulMemcpy(&st, &image->options.kernel_len,
+                 FIELD_LEN(options.kernel_len));
+  StatefulMemcpy(&st, &image->options.kernel_load_addr,
+                 FIELD_LEN(options.kernel_load_addr));
+  StatefulMemcpy(&st, &image->options.kernel_entry_addr,
+                 FIELD_LEN(options.kernel_entry_addr));
+
+  /* Read kernel config signature. */
+  image->config_signature = (uint8_t*) Malloc(kernel_signature_len);
+  StatefulMemcpy(&st, image->config_signature, kernel_signature_len);
+
+  image->kernel_signature = (uint8_t*) Malloc(kernel_signature_len);
+  StatefulMemcpy(&st, image->kernel_signature, kernel_signature_len);
+
+  image->kernel_data = (uint8_t*) Malloc(image->options.kernel_len);
+  StatefulMemcpy(&st, image->kernel_data, image->options.kernel_len);
+
+  if(st.remaining_len != 0) /* Overrun or underrun. */
+    goto parse_failure;
+
+  Free(kernel_buf);
+  return image;
+
+parse_failure:
+  Free(kernel_buf);
+  return NULL;
+}
+
+void WriteKernelHeader(int fd, KernelImage* image) {
+  int kernel_sign_key_len;
+  write(fd, &image->header_version, FIELD_LEN(header_version));
+  write(fd, &image->header_len, FIELD_LEN(header_len));
+  write(fd, &image->firmware_sign_algorithm,
+        FIELD_LEN(firmware_sign_algorithm));
+  write(fd, &image->kernel_sign_algorithm,
+        FIELD_LEN(kernel_sign_algorithm));
+  write(fd, &image->kernel_key_version, FIELD_LEN(kernel_key_version));
+  kernel_sign_key_len = (image->header_len -
+                         FIELD_LEN(header_version) -
+                         FIELD_LEN(header_len) -
+                         FIELD_LEN(firmware_sign_algorithm) -
+                         FIELD_LEN(kernel_sign_algorithm) -
+                         FIELD_LEN(kernel_key_version) -
+                         FIELD_LEN(header_checksum));
+  write(fd, image->kernel_sign_key, kernel_sign_key_len);
+  write(fd, &image->header_checksum, FIELD_LEN(header_checksum));
+}
+
+void WriteKernelConfig(int fd, KernelImage* image) {
+  write(fd, &image->kernel_version, FIELD_LEN(kernel_version));
+  write(fd, image->options.version, FIELD_LEN(options.version));
+  write(fd, &image->options.kernel_len, FIELD_LEN(options.kernel_len));
+  write(fd, &image->options.kernel_load_addr,
+        FIELD_LEN(options.kernel_load_addr));
+  write(fd, &image->options.kernel_entry_addr,
+        FIELD_LEN(options.kernel_entry_addr));
+}
+
+KernelImage* WriteKernelImage(const char* input_file,
+                              KernelImage* image) {
+  int fd;
+  int kernel_key_signature_len;
+  int kernel_signature_len;
+  if (!image)
+    return NULL;
+  if (-1 == (fd = creat(input_file,
+                        S_IRUSR | S_IWUSR))) {  /* Owner has R/W permissions. */
+    fprintf(stderr, "Couldn't open file for writing.\n");
+    return NULL;
+  }
+
+  kernel_key_signature_len = (siglen_map[image->firmware_sign_algorithm] *
+                              sizeof(uint32_t));
+  kernel_signature_len = (siglen_map[image->kernel_sign_algorithm] *
+                          sizeof(uint32_t));
+
+  write(fd, image->magic, FIELD_LEN(magic));
+  WriteKernelHeader(fd, image);
+  write(fd, image->kernel_key_signature, kernel_key_signature_len);
+  WriteKernelConfig(fd, image);
+  write(fd, image->config_signature, kernel_signature_len);
+  write(fd, image->kernel_signature, kernel_signature_len);
+  write(fd, image->kernel_data, image->options.kernel_len);
+
+  close(fd);
+  return image;
+}
+
+void PrintKernelImage(const KernelImage* image) {
+  if (!image)
+    return;
+
+  /* Print header. */
+  printf("Header Length = %d\n"
+         "Firmware Signing key algorithm id = %d\n"
+         "Kernel Signing key algorithm id = %d\n"
+         "Kernel Signature Algorithm = %s\n"
+         "Kernel Key Version = %d\n\n",
+         image->header_len,
+         image->firmware_sign_algorithm,
+         image->kernel_sign_algorithm,
+         algo_strings[image->kernel_sign_algorithm],
+         image->kernel_key_version);
+  /* TODO(gauravsh): Output hash and key signature here? */
+  /* Print preamble. */
+  printf("Kernel Version = %d\n"
+         "Kernel Config Version = %d.%d\n"
+         "kernel Length = %d\n"
+         "Kernel Load Address = %" PRId64 "\n"
+         "Kernel Entry Address = %" PRId64 "\n\n",
+         image->kernel_version,
+         image->options.version[0], image->options.version[1],
+         image->options.kernel_len,
+         image->options.kernel_load_addr,
+         image->options.kernel_entry_addr);
+  /* TODO(gauravsh): Output kernel signature here? */
+}
+
+char* kVerifyKernelErrors[VERIFY_KERNEL_MAX] = {
+  "Success.",
+  "Invalid Image.",
+  "Kernel Key Signature Failed.",
+  "Invalid Kernel Verification Algorithm.",
+  "Config Signature Failed.",
+  "Kernel Signature Failed.",
+  "Wrong Kernel Magic.",
+};
+
+int VerifyKernelHeader(const uint8_t* firmware_key_blob,
+                       const uint8_t* header_blob,
+                       const int dev_mode,
+                       int* firmware_algorithm,
+                       int* kernel_algorithm,
+                       int* kernel_header_len) {
+  int kernel_sign_key_len;
+  int firmware_sign_key_len;
+  uint16_t header_version, header_len;
+  uint16_t firmware_sign_algorithm, kernel_sign_algorithm;
+  uint8_t* header_checksum = NULL;
+
+  /* Base Offset for the header_checksum field. Actual offset is
+   * this + kernel_sign_key_len. */
+  int base_header_checksum_offset = (FIELD_LEN(header_version) +
+                                     FIELD_LEN(header_len) +
+                                     FIELD_LEN(firmware_sign_algorithm) +
+                                     FIELD_LEN(kernel_sign_algorithm) +
+                                     FIELD_LEN(kernel_key_version));
+
+  Memcpy(&header_version, header_blob, sizeof(header_version));
+  Memcpy(&header_len, header_blob + FIELD_LEN(header_version),
+         sizeof(header_len));
+  Memcpy(&firmware_sign_algorithm,
+         header_blob + (FIELD_LEN(header_version) +
+                        FIELD_LEN(header_len)),
+         sizeof(firmware_sign_algorithm));
+  Memcpy(&kernel_sign_algorithm,
+         header_blob + (FIELD_LEN(header_version) +
+                        FIELD_LEN(header_len) +
+                        FIELD_LEN(firmware_sign_algorithm)),
+         sizeof(kernel_sign_algorithm));
+
+  /* TODO(gauravsh): Make this return two different error types depending
+   * on whether the firmware or kernel signing algorithm is invalid. */
+  if (firmware_sign_algorithm >= kNumAlgorithms)
+    return VERIFY_KERNEL_INVALID_ALGORITHM;
+  if (kernel_sign_algorithm >= kNumAlgorithms)
+    return VERIFY_KERNEL_INVALID_ALGORITHM;
+
+  *firmware_algorithm = (int) firmware_sign_algorithm;
+  *kernel_algorithm = (int) kernel_sign_algorithm;
+  kernel_sign_key_len = RSAProcessedKeySize(kernel_sign_algorithm);
+  firmware_sign_key_len = RSAProcessedKeySize(firmware_sign_algorithm);
+
+
+  /* Verify if header len is correct? */
+  if (header_len != (base_header_checksum_offset +
+                     kernel_sign_key_len +
+                     FIELD_LEN(header_checksum))) {
+    fprintf(stderr, "VerifyKernelHeader: Header length mismatch\n");
+    return VERIFY_KERNEL_INVALID_IMAGE;
+  }
+  *kernel_header_len = (int) header_len;
+
+  /* Verify if the hash of the header is correct. */
+  header_checksum = DigestBuf(header_blob,
+                              header_len - FIELD_LEN(header_checksum),
+                              SHA512_DIGEST_ALGORITHM);
+  if (SafeMemcmp(header_checksum,
+                 header_blob + (base_header_checksum_offset +
+                                kernel_sign_key_len),
+                 FIELD_LEN(header_checksum))) {
+    Free(header_checksum);
+    return VERIFY_KERNEL_INVALID_IMAGE;
+  }
+  Free(header_checksum);
+
+  /* Verify kernel key signature unless we are in dev mode. */
+  if (!dev_mode) {
+    if (!RSAVerifyBinary_f(firmware_key_blob, NULL,  /* Key to use */
+                           header_blob,  /* Data to verify */
+                           header_len, /* Length of data */
+                           header_blob + header_len,  /* Expected Signature */
+                           firmware_sign_algorithm))
+      return VERIFY_KERNEL_KEY_SIGNATURE_FAILED;
+  }
+  return 0;
+}
+
+int VerifyKernelConfig(RSAPublicKey* kernel_sign_key,
+                       const uint8_t* config_blob,
+                       int algorithm,
+                       int* kernel_len) {
+  uint32_t len, config_len;
+  config_len = (FIELD_LEN(kernel_version) +
+                FIELD_LEN(options.version)+
+                FIELD_LEN(options.kernel_len) +
+                FIELD_LEN(options.kernel_load_addr) +
+                FIELD_LEN(options.kernel_entry_addr));
+  if (!RSAVerifyBinary_f(NULL, kernel_sign_key,  /* Key to use */
+                         config_blob,  /* Data to verify */
+                         config_len,  /* Length of data */
+                         config_blob + config_len,  /* Expected Signature */
+                         algorithm))
+    return VERIFY_KERNEL_CONFIG_SIGNATURE_FAILED;
+
+  Memcpy(&len, config_blob + (FIELD_LEN(kernel_version)+
+                              FIELD_LEN(options.version)),
+         sizeof(len));
+  *kernel_len = (int) len;
+  return 0;
+}
+
+int VerifyKernelData(RSAPublicKey* kernel_sign_key,
+                     const uint8_t* kernel_data_start,
+                     int kernel_len,
+                     int algorithm) {
+  int signature_len = siglen_map[algorithm] * sizeof(uint32_t);
+  if (!RSAVerifyBinary_f(NULL, kernel_sign_key,  /* Key to use. */
+                         kernel_data_start + signature_len,  /* Data to
+                                                              * verify */
+                         kernel_len,  /* Length of data. */
+                         kernel_data_start,  /* Expected Signature */
+                         algorithm))
+    return VERIFY_KERNEL_SIGNATURE_FAILED;
+  return 0;
+}
+
+int VerifyKernel(const uint8_t* firmware_key_blob,
+                 const uint8_t* kernel_blob,
+                 const int dev_mode) {
+  int error_code;
+  int firmware_sign_algorithm;  /* Firmware signing key algorithm. */
+  int kernel_sign_algorithm;  /* Kernel Signing key algorithm. */
+  RSAPublicKey* kernel_sign_key;
+  int kernel_sign_key_len, kernel_key_signature_len, kernel_signature_len,
+      header_len, kernel_len;
+  const uint8_t* header_ptr;  /* Pointer to header. */
+  const uint8_t* kernel_sign_key_ptr;  /* Pointer to signing key. */
+  const uint8_t* config_ptr;  /* Pointer to kernel config block. */
+  const uint8_t* kernel_ptr;  /* Pointer to kernel signature/data. */
+
+  /* Note: All the offset calculations are based on struct FirmwareImage which
+   * is defined in include/firmware_image.h. */
+
+  /* Compare magic bytes. */
+  if (SafeMemcmp(kernel_blob, KERNEL_MAGIC, KERNEL_MAGIC_SIZE))
+    return VERIFY_KERNEL_WRONG_MAGIC;
+  header_ptr = kernel_blob + KERNEL_MAGIC_SIZE;
+
+  /* Only continue if header verification succeeds. */
+  if ((error_code = VerifyKernelHeader(firmware_key_blob, header_ptr, dev_mode,
+                                       &firmware_sign_algorithm,
+                                       &kernel_sign_algorithm, &header_len))) {
+    fprintf(stderr, "VerifyKernel: Kernel header verification failed.\n");
+    return error_code;  /* AKA jump to recovery. */
+  }
+  /* Parse signing key into RSAPublicKey structure since it is required multiple
+   * times. */
+  kernel_sign_key_len = RSAProcessedKeySize(kernel_sign_algorithm);
+  kernel_sign_key_ptr = header_ptr + (FIELD_LEN(header_version) +
+                                      FIELD_LEN(header_len) +
+                                      FIELD_LEN(firmware_sign_algorithm) +
+                                      FIELD_LEN(kernel_sign_algorithm) +
+                                      FIELD_LEN(kernel_key_version));
+  kernel_sign_key = RSAPublicKeyFromBuf(kernel_sign_key_ptr,
+                                        kernel_sign_key_len);
+  kernel_signature_len = siglen_map[kernel_sign_algorithm] * sizeof(uint32_t);
+  kernel_key_signature_len = siglen_map[firmware_sign_algorithm] *
+      sizeof(uint32_t);
+
+  /* Only continue if config verification succeeds. */
+  config_ptr = (header_ptr + header_len + kernel_key_signature_len);
+  if ((error_code = VerifyKernelConfig(kernel_sign_key, config_ptr,
+                                       kernel_sign_algorithm,
+                                       &kernel_len)))
+    return error_code;  /* AKA jump to recovery. */
+  /* Only continue if kernel data verification succeeds. */
+  kernel_ptr = (config_ptr +
+                FIELD_LEN(kernel_version) +
+                FIELD_LEN(options.version) +
+                FIELD_LEN(options.kernel_len) +
+                FIELD_LEN(options.kernel_entry_addr) +
+                FIELD_LEN(options.kernel_load_addr) +
+                kernel_signature_len);
+
+  if ((error_code = VerifyKernelData(kernel_sign_key, kernel_ptr, kernel_len,
+                                     kernel_sign_algorithm)))
+    return error_code;  /* AKA jump to recovery. */
+  return 0;  /* Success! */
+}
+
+int VerifyKernelImage(const RSAPublicKey* firmware_key,
+                      const KernelImage* image,
+                      const int dev_mode) {
+  RSAPublicKey* kernel_sign_key;
+  uint8_t* header_digest = NULL;
+  uint8_t* config_digest = NULL;
+  uint8_t* kernel_digest = NULL;
+  int kernel_sign_key_size;
+  int kernel_signature_size;
+  int error_code = 0;
+  DigestContext ctx;
+
+  if (!image)
+    return VERIFY_KERNEL_INVALID_IMAGE;
+
+  /* Verify kernel key signature on the key header if we
+   * are not in dev mode.
+   *
+   * TODO(gauravsh): Add additional sanity checks here for:
+   *  1) verifying the header length is correct.
+   *  2) header_checksum is correct.
+   */
+
+  if (image->firmware_sign_algorithm >= kNumAlgorithms)
+    return VERIFY_KERNEL_INVALID_ALGORITHM;
+  if (image->kernel_sign_algorithm >= kNumAlgorithms)
+    return VERIFY_KERNEL_INVALID_ALGORITHM;
+
+  if (!dev_mode) {
+    DigestInit(&ctx, image->firmware_sign_algorithm);
+    DigestUpdate(&ctx, (uint8_t*) &image->header_version,
+                 FIELD_LEN(header_version));
+    DigestUpdate(&ctx, (uint8_t*) &image->header_len,
+                 FIELD_LEN(header_len));
+    DigestUpdate(&ctx, (uint8_t*) &image->firmware_sign_algorithm,
+                 FIELD_LEN(firmware_sign_algorithm));
+    DigestUpdate(&ctx, (uint8_t*) &image->kernel_sign_algorithm,
+                 FIELD_LEN(kernel_sign_algorithm));
+    DigestUpdate(&ctx, (uint8_t*) &image->kernel_key_version,
+                 FIELD_LEN(kernel_key_version));
+    DigestUpdate(&ctx, image->kernel_sign_key,
+                 RSAProcessedKeySize(image->kernel_sign_algorithm));
+    DigestUpdate(&ctx, image->header_checksum,
+                 FIELD_LEN(header_checksum));
+    header_digest = DigestFinal(&ctx);
+    if (!RSA_verify(firmware_key, image->kernel_key_signature,
+                    siglen_map[image->firmware_sign_algorithm] *
+                    sizeof(uint32_t),
+                    image->firmware_sign_algorithm,
+                    header_digest)) {
+      fprintf(stderr, "VerifyKernelImage(): Key signature check failed.\n");
+      error_code =  VERIFY_KERNEL_KEY_SIGNATURE_FAILED;
+      goto verify_failure;
+    }
+  }
+
+  /* Get kernel signing key to verify the rest of the kernel. */
+  kernel_sign_key_size = RSAProcessedKeySize(image->kernel_sign_algorithm);
+  kernel_sign_key = RSAPublicKeyFromBuf(image->kernel_sign_key,
+                                        kernel_sign_key_size);
+  kernel_signature_size = siglen_map[image->kernel_sign_algorithm] *
+      sizeof(uint32_t);
+
+  /* Verify kernel config signature. */
+  DigestInit(&ctx, image->kernel_sign_algorithm);
+  DigestUpdate(&ctx, (uint8_t*) &image->kernel_version,
+               FIELD_LEN(kernel_version));
+  DigestUpdate(&ctx, (uint8_t*) &image->options.version,
+               FIELD_LEN(options.version));
+  DigestUpdate(&ctx, (uint8_t*) &image->options.kernel_len,
+               FIELD_LEN(options.kernel_len));
+  DigestUpdate(&ctx, (uint8_t*) &image->options.kernel_load_addr,
+               FIELD_LEN(options.kernel_load_addr));
+  DigestUpdate(&ctx, (uint8_t*) &image->options.kernel_entry_addr,
+               FIELD_LEN(options.kernel_entry_addr));
+  config_digest = DigestFinal(&ctx);
+  if (!RSA_verify(kernel_sign_key, image->config_signature,
+                  kernel_signature_size, image->kernel_sign_algorithm,
+                  config_digest)) {
+    error_code = VERIFY_KERNEL_CONFIG_SIGNATURE_FAILED;
+    goto verify_failure;
+  }
+
+  /* Verify firmware signature. */
+  kernel_digest = DigestBuf(image->kernel_data,
+                            image->options.kernel_len,
+                            image->kernel_sign_algorithm);
+  if(!RSA_verify(kernel_sign_key, image->kernel_signature,
+                 kernel_signature_size, image->kernel_sign_algorithm,
+                 kernel_digest)) {
+    error_code = VERIFY_KERNEL_SIGNATURE_FAILED;
+    goto verify_failure;
+  }
+
+verify_failure:
+  Free(kernel_digest);
+  Free(config_digest);
+  Free(header_digest);
+  return error_code;
+}
+
+const char* VerifyKernelErrorString(int error) {
+  return kVerifyKernelErrors[error];
+}
+
+int AddKernelKeySignature(KernelImage* image, const char* firmware_key_file) {
+  int tmp_hdr_fd;
+  char* tmp_hdr_file = ".tmpKernelHdrFile";
+  uint8_t* signature;
+  int signature_len = siglen_map[image->firmware_sign_algorithm] *
+      sizeof(uint32_t);
+
+  if(-1 == (tmp_hdr_fd = creat(tmp_hdr_file, S_IRWXU))) {
+    fprintf(stderr, "Could not open temporary file for writing "
+            "kernel header.\n");
+    return 0;
+  }
+  WriteKernelHeader(tmp_hdr_fd, image);
+  close(tmp_hdr_fd);
+  if (!(signature = SignatureFile(tmp_hdr_file, firmware_key_file,
+                                  image->firmware_sign_algorithm)))
+    return 0;
+  image->kernel_key_signature = Malloc(signature_len);
+  Memcpy(image->kernel_key_signature, signature, signature_len);
+  return 1;
+}
+
+int AddKernelSignature(KernelImage* image, const char* kernel_signing_key_file,
+                       int algorithm) {
+  int tmp_config_fd;
+  char* tmp_config_file = ".tmpConfigFile";
+  int tmp_kernel_fd;
+  char* tmp_kernel_file = ".tmpKernelFile";
+  uint8_t* config_signature;
+  uint8_t* kernel_signature;
+  int signature_len = siglen_map[algorithm] * sizeof(uint32_t);
+
+  /* Write config to a file. */
+  if(-1 == (tmp_config_fd = creat(tmp_config_file, S_IRWXU))) {
+    fprintf(stderr, "Could not open temporary file for writing "
+            "kernel config.\n");
+    return 0;
+  }
+  WriteKernelConfig(tmp_config_fd, image);
+  close(tmp_config_fd);
+  if (!(config_signature = SignatureFile(tmp_config_file,
+                                         kernel_signing_key_file,
+                                         algorithm)))
+    return 0;
+  image->config_signature = (uint8_t*) Malloc(signature_len);
+  Memcpy(image->config_signature, config_signature, signature_len);
+  Free(config_signature);
+
+  if (-1 == (tmp_kernel_fd = creat(tmp_kernel_file, S_IRWXU))) {
+    fprintf(stderr, "Could not open temporary file for writing "
+            "kernel.\n");
+    return 0;
+  }
+  write(tmp_kernel_fd, image->kernel_data, image->options.kernel_len);
+  close(tmp_kernel_fd);
+
+  if (!(kernel_signature = SignatureFile(tmp_kernel_file,
+                                         kernel_signing_key_file,
+                                         algorithm))) {
+    fprintf(stderr, "Could not compute signature on the kernel.\n");
+    return 0;
+  }
+  image->kernel_signature = (uint8_t*) Malloc(signature_len);
+  Memcpy(image->kernel_signature, kernel_signature, signature_len);
+  Free(kernel_signature);
+  return 1;
+}