125 lines
		
	
	
		
			3.3 KiB
		
	
	
	
		
			C
		
	
	
	
			
		
		
	
	
			125 lines
		
	
	
		
			3.3 KiB
		
	
	
	
		
			C
		
	
	
	
// SPDX-License-Identifier: GPL-2.0+
 | 
						|
/*
 | 
						|
 * (C) Copyright 2009-2016 CompuLab, Ltd.
 | 
						|
 *
 | 
						|
 * Authors: Nikita Kiryanov <nikita@compulab.co.il>
 | 
						|
 *	    Igor Grinberg <grinberg@compulab.co.il>
 | 
						|
 */
 | 
						|
 | 
						|
#include <common.h>
 | 
						|
#include <linux/kernel.h>
 | 
						|
#include <eeprom_layout.h>
 | 
						|
#include <eeprom_field.h>
 | 
						|
 | 
						|
#define NO_LAYOUT_FIELDS	"Unknown layout. Dumping raw data\n"
 | 
						|
 | 
						|
struct eeprom_field layout_unknown[1] = {
 | 
						|
	{ NO_LAYOUT_FIELDS, 256, NULL, eeprom_field_print_bin,
 | 
						|
				       eeprom_field_update_bin },
 | 
						|
};
 | 
						|
 | 
						|
/*
 | 
						|
 * eeprom_layout_detect() - detect layout based on the contents of the data.
 | 
						|
 * @data: Pointer to the data to be analyzed.
 | 
						|
 *
 | 
						|
 * Returns: the detected layout version.
 | 
						|
 */
 | 
						|
__weak int eeprom_layout_detect(unsigned char *data)
 | 
						|
{
 | 
						|
	return LAYOUT_VERSION_UNRECOGNIZED;
 | 
						|
}
 | 
						|
 | 
						|
/*
 | 
						|
 * __eeprom_layout_assign() - set the layout fields
 | 
						|
 * @layout:		A pointer to an existing struct layout.
 | 
						|
 * @layout_version:	The version number of the desired layout
 | 
						|
 */
 | 
						|
__weak void __eeprom_layout_assign(struct eeprom_layout *layout,
 | 
						|
				   int layout_version)
 | 
						|
{
 | 
						|
	layout->fields = layout_unknown;
 | 
						|
	layout->num_of_fields = ARRAY_SIZE(layout_unknown);
 | 
						|
}
 | 
						|
void eeprom_layout_assign(struct eeprom_layout *layout, int layout_version) \
 | 
						|
		__attribute__((weak, alias("__eeprom_layout_assign")));
 | 
						|
 | 
						|
/*
 | 
						|
 * eeprom_layout_print() - print the layout and the data which is assigned to it
 | 
						|
 * @layout: A pointer to an existing struct layout.
 | 
						|
 */
 | 
						|
static void eeprom_layout_print(const struct eeprom_layout *layout)
 | 
						|
{
 | 
						|
	int i;
 | 
						|
	struct eeprom_field *fields = layout->fields;
 | 
						|
 | 
						|
	for (i = 0; i < layout->num_of_fields; i++)
 | 
						|
		fields[i].print(&fields[i]);
 | 
						|
}
 | 
						|
 | 
						|
/*
 | 
						|
 * eeprom_layout_update_field() - update a single field in the layout data.
 | 
						|
 * @layout:	A pointer to an existing struct layout.
 | 
						|
 * @field_name:	The name of the field to update.
 | 
						|
 * @new_data:	The new field data (a string. Format depends on the field)
 | 
						|
 *
 | 
						|
 * Returns: 0 on success, negative error value on failure.
 | 
						|
 */
 | 
						|
static int eeprom_layout_update_field(struct eeprom_layout *layout,
 | 
						|
				      char *field_name, char *new_data)
 | 
						|
{
 | 
						|
	int i, err;
 | 
						|
	struct eeprom_field *fields = layout->fields;
 | 
						|
 | 
						|
	if (new_data == NULL)
 | 
						|
		return 0;
 | 
						|
 | 
						|
	if (field_name == NULL)
 | 
						|
		return -1;
 | 
						|
 | 
						|
	for (i = 0; i < layout->num_of_fields; i++) {
 | 
						|
		if (fields[i].name == RESERVED_FIELDS ||
 | 
						|
		    strcmp(fields[i].name, field_name))
 | 
						|
			continue;
 | 
						|
 | 
						|
		err = fields[i].update(&fields[i], new_data);
 | 
						|
		if (err)
 | 
						|
			printf("Invalid data for field %s\n", field_name);
 | 
						|
 | 
						|
		return err;
 | 
						|
	}
 | 
						|
 | 
						|
	printf("No such field '%s'\n", field_name);
 | 
						|
 | 
						|
	return -1;
 | 
						|
}
 | 
						|
 | 
						|
/*
 | 
						|
 * eeprom_layout_setup() - setup layout struct with the layout data and
 | 
						|
 *			   metadata as dictated by layout_version
 | 
						|
 * @layout:	A pointer to an existing struct layout.
 | 
						|
 * @buf:	A buffer initialized with the eeprom data.
 | 
						|
 * @buf_size:	Size of buf in bytes.
 | 
						|
 * @layout version: The version number of the layout.
 | 
						|
 */
 | 
						|
void eeprom_layout_setup(struct eeprom_layout *layout, unsigned char *buf,
 | 
						|
			 unsigned int buf_size, int layout_version)
 | 
						|
{
 | 
						|
	int i;
 | 
						|
 | 
						|
	if (layout_version == LAYOUT_VERSION_AUTODETECT)
 | 
						|
		layout->layout_version = eeprom_layout_detect(buf);
 | 
						|
	else
 | 
						|
		layout->layout_version = layout_version;
 | 
						|
 | 
						|
	eeprom_layout_assign(layout, layout_version);
 | 
						|
	layout->data = buf;
 | 
						|
	for (i = 0; i < layout->num_of_fields; i++) {
 | 
						|
		layout->fields[i].buf = buf;
 | 
						|
		buf += layout->fields[i].size;
 | 
						|
	}
 | 
						|
 | 
						|
	layout->data_size = buf_size;
 | 
						|
	layout->print = eeprom_layout_print;
 | 
						|
	layout->update = eeprom_layout_update_field;
 | 
						|
}
 |