75 lines
		
	
	
		
			1.9 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			75 lines
		
	
	
		
			1.9 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
/*
 | 
						|
 * Compact binary representation of ihex records. Some devices need their
 | 
						|
 * firmware loaded in strange orders rather than a single big blob, but
 | 
						|
 * actually parsing ihex-as-text within the kernel seems silly. Thus,...
 | 
						|
 */
 | 
						|
 | 
						|
#ifndef __LINUX_IHEX_H__
 | 
						|
#define __LINUX_IHEX_H__
 | 
						|
 | 
						|
#include <linux/types.h>
 | 
						|
#include <linux/firmware.h>
 | 
						|
#include <linux/device.h>
 | 
						|
 | 
						|
/* Intel HEX files actually limit the length to 256 bytes, but we have
 | 
						|
   drivers which would benefit from using separate records which are
 | 
						|
   longer than that, so we extend to 16 bits of length */
 | 
						|
struct ihex_binrec {
 | 
						|
	__be32 addr;
 | 
						|
	__be16 len;
 | 
						|
	uint8_t data[0];
 | 
						|
} __attribute__((packed));
 | 
						|
 | 
						|
/* Find the next record, taking into account the 4-byte alignment */
 | 
						|
static inline const struct ihex_binrec *
 | 
						|
ihex_next_binrec(const struct ihex_binrec *rec)
 | 
						|
{
 | 
						|
	int next = ((be16_to_cpu(rec->len) + 5) & ~3) - 2;
 | 
						|
	rec = (void *)&rec->data[next];
 | 
						|
 | 
						|
	return be16_to_cpu(rec->len) ? rec : NULL;
 | 
						|
}
 | 
						|
 | 
						|
/* Check that ihex_next_binrec() won't take us off the end of the image... */
 | 
						|
static inline int ihex_validate_fw(const struct firmware *fw)
 | 
						|
{
 | 
						|
	const struct ihex_binrec *rec;
 | 
						|
	size_t ofs = 0;
 | 
						|
 | 
						|
	while (ofs <= fw->size - sizeof(*rec)) {
 | 
						|
		rec = (void *)&fw->data[ofs];
 | 
						|
 | 
						|
		/* Zero length marks end of records */
 | 
						|
		if (!be16_to_cpu(rec->len))
 | 
						|
			return 0;
 | 
						|
 | 
						|
		/* Point to next record... */
 | 
						|
		ofs += (sizeof(*rec) + be16_to_cpu(rec->len) + 3) & ~3;
 | 
						|
	}
 | 
						|
	return -EINVAL;
 | 
						|
}
 | 
						|
 | 
						|
/* Request firmware and validate it so that we can trust we won't
 | 
						|
 * run off the end while reading records... */
 | 
						|
static inline int request_ihex_firmware(const struct firmware **fw,
 | 
						|
					const char *fw_name,
 | 
						|
					struct device *dev)
 | 
						|
{
 | 
						|
	const struct firmware *lfw;
 | 
						|
	int ret;
 | 
						|
 | 
						|
	ret = request_firmware(&lfw, fw_name, dev);
 | 
						|
	if (ret)
 | 
						|
		return ret;
 | 
						|
	ret = ihex_validate_fw(lfw);
 | 
						|
	if (ret) {
 | 
						|
		dev_err(dev, "Firmware \"%s\" not valid IHEX records\n",
 | 
						|
			fw_name);
 | 
						|
		release_firmware(lfw);
 | 
						|
		return ret;
 | 
						|
	}
 | 
						|
	*fw = lfw;
 | 
						|
	return 0;
 | 
						|
}
 | 
						|
#endif /* __LINUX_IHEX_H__ */
 |