/* * Copyright (C) 2019 Richard Hughes * * SPDX-License-Identifier: LGPL-2.1+ */ #define G_LOG_DOMAIN "FuFirmware" #include "config.h" #include "fu-common.h" #include "fu-dfu-firmware.h" /** * SECTION:fu-dfu-firmware * @short_description: DFU firmware image * * An object that represents a DFU firmware image. * * See also: #FuFirmware */ typedef struct { guint16 vid; guint16 pid; guint16 release; guint16 version; } FuDfuFirmwarePrivate; G_DEFINE_TYPE_WITH_PRIVATE (FuDfuFirmware, fu_dfu_firmware, FU_TYPE_FIRMWARE) #define GET_PRIVATE(o) (fu_dfu_firmware_get_instance_private (o)) static void fu_dfu_firmware_to_string (FuFirmware *firmware, guint idt, GString *str) { FuDfuFirmware *self = FU_DFU_FIRMWARE (firmware); FuDfuFirmwarePrivate *priv = GET_PRIVATE (self); fu_common_string_append_kx (str, idt, "Vid", priv->vid); fu_common_string_append_kx (str, idt, "Pid", priv->pid); fu_common_string_append_kx (str, idt, "Release", priv->release); fu_common_string_append_kx (str, idt, "Version", priv->version); } /** * fu_dfu_firmware_get_vid: * @self: a #FuDfuFirmware * * Gets the vendor ID, or 0xffff for no restriction. * * Return value: integer * * Since: 1.3.3 **/ guint16 fu_dfu_firmware_get_vid (FuDfuFirmware *self) { FuDfuFirmwarePrivate *priv = GET_PRIVATE (self); g_return_val_if_fail (FU_IS_DFU_FIRMWARE (self), 0x0); return priv->vid; } /** * fu_dfu_firmware_get_pid: * @self: a #FuDfuFirmware * * Gets the product ID, or 0xffff for no restriction. * * Return value: integer * * Since: 1.3.3 **/ guint16 fu_dfu_firmware_get_pid (FuDfuFirmware *self) { FuDfuFirmwarePrivate *priv = GET_PRIVATE (self); g_return_val_if_fail (FU_IS_DFU_FIRMWARE (self), 0x0); return priv->pid; } /** * fu_dfu_firmware_get_release: * @self: a #FuDfuFirmware * * Gets the device ID, or 0xffff for no restriction. * * Return value: integer * * Since: 1.3.3 **/ guint16 fu_dfu_firmware_get_release (FuDfuFirmware *self) { FuDfuFirmwarePrivate *priv = GET_PRIVATE (self); g_return_val_if_fail (FU_IS_DFU_FIRMWARE (self), 0x0); return priv->release; } /** * fu_dfu_firmware_get_version: * @self: a #FuDfuFirmware * * Gets the file format version with is 0x0100 by default. * * Return value: integer * * Since: 1.3.3 **/ guint16 fu_dfu_firmware_get_version (FuDfuFirmware *self) { FuDfuFirmwarePrivate *priv = GET_PRIVATE (self); g_return_val_if_fail (FU_IS_DFU_FIRMWARE (self), 0x0); return priv->version; } /** * fu_dfu_firmware_set_vid: * @self: a #FuDfuFirmware * @vid: vendor ID, or 0xffff if the firmware should match any vendor * * Sets the vendor ID. * * Since: 1.3.3 **/ void fu_dfu_firmware_set_vid (FuDfuFirmware *self, guint16 vid) { FuDfuFirmwarePrivate *priv = GET_PRIVATE (self); g_return_if_fail (FU_IS_DFU_FIRMWARE (self)); priv->vid = vid; } /** * fu_dfu_firmware_set_pid: * @self: a #FuDfuFirmware * @pid: product ID, or 0xffff if the firmware should match any product * * Sets the product ID. * * Since: 1.3.3 **/ void fu_dfu_firmware_set_pid (FuDfuFirmware *self, guint16 pid) { FuDfuFirmwarePrivate *priv = GET_PRIVATE (self); g_return_if_fail (FU_IS_DFU_FIRMWARE (self)); priv->pid = pid; } /** * fu_dfu_firmware_set_release: * @self: a #FuDfuFirmware * @release: release, or 0xffff if the firmware should match any release * * Sets the release for the dfu firmware. * * Since: 1.3.3 **/ void fu_dfu_firmware_set_release (FuDfuFirmware *self, guint16 release) { FuDfuFirmwarePrivate *priv = GET_PRIVATE (self); g_return_if_fail (FU_IS_DFU_FIRMWARE (self)); priv->release = release; } /** * fu_dfu_firmware_set_version: * @self: a #FuDfuFirmware * @version: integer * * Sets the file format version. * * Since: 1.3.3 **/ void fu_dfu_firmware_set_version (FuDfuFirmware *self, guint16 version) { FuDfuFirmwarePrivate *priv = GET_PRIVATE (self); g_return_if_fail (FU_IS_DFU_FIRMWARE (self)); priv->version = version; } typedef struct __attribute__((packed)) { guint16 release; guint16 pid; guint16 vid; guint16 ver; guint8 sig[3]; guint8 len; guint32 crc; } FuDfuFirmwareFooter; static gboolean fu_dfu_firmware_parse (FuFirmware *firmware, GBytes *fw, guint64 addr_start, guint64 addr_end, FwupdInstallFlags flags, GError **error) { FuDfuFirmware *self = FU_DFU_FIRMWARE (firmware); FuDfuFirmwarePrivate *priv = GET_PRIVATE (self); FuDfuFirmwareFooter ftr; gsize len; guint32 crc; guint32 crc_new; guint8 *data; g_autoptr(FuFirmwareImage) image = NULL; g_autoptr(GBytes) contents = NULL; /* check data size */ data = (guint8 *) g_bytes_get_data (fw, &len); if (len < sizeof(FuDfuFirmwareFooter)) { g_set_error_literal (error, FWUPD_ERROR, FWUPD_ERROR_INTERNAL, "size check failed, too small"); return FALSE; } /* check for DFU signature */ if (memcmp (&data[len - G_STRUCT_OFFSET (FuDfuFirmwareFooter, sig)], "UFD", sizeof(ftr.sig)) != 0) { g_set_error_literal (error, FWUPD_ERROR, FWUPD_ERROR_INTERNAL, "no DFU signature"); return FALSE; } /* verify the checksum */ if (!fu_memcpy_safe ((guint8 *) &ftr, sizeof(FuDfuFirmwareFooter), 0x0, /* dst */ data, len, len - sizeof(FuDfuFirmwareFooter), /* src */ sizeof(FuDfuFirmwareFooter), error)) return FALSE; crc = GUINT32_FROM_LE(ftr.crc); if ((flags & FWUPD_INSTALL_FLAG_IGNORE_CHECKSUM) == 0) { crc_new = ~fu_common_crc32 (data, len - 4); if (crc != crc_new) { g_set_error (error, FWUPD_ERROR, FWUPD_ERROR_INTERNAL, "CRC failed, expected %04x, got %04x", crc_new, GUINT32_FROM_LE(ftr.crc)); return FALSE; } } /* set from footer */ priv->vid = GUINT16_FROM_LE(ftr.vid); priv->pid = GUINT16_FROM_LE(ftr.pid); priv->release = GUINT16_FROM_LE(ftr.release); priv->version = GUINT16_FROM_LE(ftr.ver); /* check reported length */ if (ftr.len > len) { g_set_error (error, FWUPD_ERROR, FWUPD_ERROR_INTERNAL, "reported firmware size %04x larger than file %04x", (guint) ftr.len, (guint) len); return FALSE; } /* success */ contents = g_bytes_new_from_bytes (fw, 0, len - ftr.len); image = fu_firmware_image_new (contents); fu_firmware_add_image (firmware, image); return TRUE; } static GBytes * fu_dfu_firmware_add_footer (FuDfuFirmware *self, GBytes *contents, GError **error) { FuDfuFirmwarePrivate *priv = GET_PRIVATE (self); GByteArray *buf = g_byte_array_new (); const guint8 *blob; gsize blobsz = 0; /* add the raw firmware data */ blob = g_bytes_get_data (contents, &blobsz); g_byte_array_append (buf, blob, blobsz); /* append footer */ fu_byte_array_append_uint16 (buf, priv->release, G_LITTLE_ENDIAN); fu_byte_array_append_uint16 (buf, priv->pid, G_LITTLE_ENDIAN); fu_byte_array_append_uint16 (buf, priv->vid, G_LITTLE_ENDIAN); fu_byte_array_append_uint16 (buf, priv->version, G_LITTLE_ENDIAN); g_byte_array_append (buf, (const guint8 *) "UFD", 3); fu_byte_array_append_uint8 (buf, sizeof(FuDfuFirmwareFooter)); fu_byte_array_append_uint32 (buf, ~fu_common_crc32 (buf->data, buf->len), G_LITTLE_ENDIAN); return g_byte_array_free_to_bytes (buf); } static GBytes * fu_dfu_firmware_write (FuFirmware *firmware, GError **error) { FuDfuFirmware *self = FU_DFU_FIRMWARE (firmware); g_autoptr(GPtrArray) images = fu_firmware_get_images (firmware); g_autoptr(GBytes) fw = NULL; /* can only contain one image */ if (images->len > 1) { g_set_error (error, FWUPD_ERROR, FWUPD_ERROR_NOT_SUPPORTED, "DFU only supports writing one image"); return NULL; } /* add footer */ fw = fu_firmware_get_image_default_bytes (firmware, error); if (fw == NULL) return NULL; return fu_dfu_firmware_add_footer (self, fw, error); } static void fu_dfu_firmware_init (FuDfuFirmware *self) { FuDfuFirmwarePrivate *priv = GET_PRIVATE (self); priv->vid = 0xffff; priv->pid = 0xffff; priv->release = 0xffff; priv->version = 0x0100; } static void fu_dfu_firmware_class_init (FuDfuFirmwareClass *klass) { FuFirmwareClass *klass_firmware = FU_FIRMWARE_CLASS (klass); klass_firmware->to_string = fu_dfu_firmware_to_string; klass_firmware->parse = fu_dfu_firmware_parse; klass_firmware->write = fu_dfu_firmware_write; } /** * fu_dfu_firmware_new: * * Creates a new #FuFirmware of sub type Dfu * * Since: 1.3.3 **/ FuFirmware * fu_dfu_firmware_new (void) { return FU_FIRMWARE (g_object_new (FU_TYPE_DFU_FIRMWARE, NULL)); }