| // 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 <linux/kernel.h> |
| #include <linux/string.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_find_field() - finds a layout field by name |
| * @layout: A pointer to an existing struct layout. |
| * @field_name: The name of the field to update. |
| * @warn: Whether to print a warning if the field is not found. |
| * |
| * Returns: a pointer to the found field or NULL on failure. |
| */ |
| struct eeprom_field *eeprom_layout_find_field(struct eeprom_layout *layout, |
| char *field_name, bool warn) |
| { |
| for (int i = 0; i < layout->num_of_fields; i++) |
| if (layout->fields[i].name != RESERVED_FIELDS && |
| !strcmp(layout->fields[i].name, field_name)) |
| return &layout->fields[i]; |
| |
| if (warn) |
| printf("No such field '%s'\n", field_name); |
| |
| return NULL; |
| } |
| |
| /* |
| * 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) |
| { |
| struct eeprom_field *field; |
| int err; |
| |
| if (new_data == NULL) |
| return 0; |
| |
| if (field_name == NULL) |
| return -1; |
| |
| field = eeprom_layout_find_field(layout, field_name, true); |
| if (field == NULL) |
| return -1; |
| |
| err = field->update(field, new_data); |
| if (err) |
| printf("Invalid data for field %s\n", field_name); |
| |
| return err; |
| } |
| |
| /* |
| * 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; |
| |
| layout->data_size = buf_size; |
| layout->print = eeprom_layout_print; |
| layout->update = eeprom_layout_update_field; |
| |
| 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; |
| } |
| } |