Merge branch 'issue/18-Backup-RAM' into issue/15-safety-controller-hardening
This commit is contained in:
		@@ -23,6 +23,10 @@
 | 
			
		||||
 | 
			
		||||
#include <stdint.h>
 | 
			
		||||
 | 
			
		||||
/** @addtogroup safety-memory
 | 
			
		||||
 * @{
 | 
			
		||||
 */
 | 
			
		||||
 | 
			
		||||
/**
 | 
			
		||||
 * @brief Magic number to signal a valid safety memory header.
 | 
			
		||||
 */
 | 
			
		||||
@@ -81,23 +85,37 @@ struct safety_memory_boot_status {
 | 
			
		||||
	uint32_t reset_from_panic;
 | 
			
		||||
};
 | 
			
		||||
 | 
			
		||||
/**
 | 
			
		||||
 * @brief The state of the safety memory
 | 
			
		||||
 *
 | 
			
		||||
 * This is returned by certain functions in order to signal, if the header and CRC infos are valid.
 | 
			
		||||
 */
 | 
			
		||||
enum safety_memory_state {
 | 
			
		||||
	SAFETY_MEMORY_INIT_FRESH = 0,
 | 
			
		||||
	SAFETY_MEMORY_INIT_CORRUPTED = 1,
 | 
			
		||||
	SAFETY_MEMORY_INIT_VALID_MEMORY = 2,
 | 
			
		||||
	SAFETY_MEMORY_INIT_FRESH = 0,		/**< @brief Memory header not found */
 | 
			
		||||
	SAFETY_MEMORY_INIT_CORRUPTED = 1,	/**< @brief Header found, but corrupt memory */
 | 
			
		||||
	SAFETY_MEMORY_INIT_VALID_MEMORY = 2,	/**< @brief Valid header found and CRC check is valid */
 | 
			
		||||
};
 | 
			
		||||
 | 
			
		||||
/**
 | 
			
		||||
 * @brief Types of error memory entries
 | 
			
		||||
 */
 | 
			
		||||
enum safety_memory_error_entry_type {
 | 
			
		||||
	SAFETY_MEMORY_ERR_ENTRY_FLAG = 1,
 | 
			
		||||
	SAFETY_MEMORY_ERR_ENTRY_NOP = 2,
 | 
			
		||||
	SAFETY_MEMORY_ERR_ENTRY_FLAG = 1,	/**< @brief Flag error entry. Logs a flag */
 | 
			
		||||
	SAFETY_MEMORY_ERR_ENTRY_NOP = 2,	/**< @brief NOP entry. Has no meaning, but will be treated as a valid entry */
 | 
			
		||||
};
 | 
			
		||||
 | 
			
		||||
/**
 | 
			
		||||
 * @brief Firmware internal representation of an error memory entry.
 | 
			
		||||
 */
 | 
			
		||||
struct error_memory_entry {
 | 
			
		||||
	enum safety_memory_error_entry_type type;
 | 
			
		||||
	uint8_t flag_num;
 | 
			
		||||
	uint16_t counter;
 | 
			
		||||
};
 | 
			
		||||
 | 
			
		||||
/**
 | 
			
		||||
 * @brief Types of conig override entries
 | 
			
		||||
 */
 | 
			
		||||
enum config_override_entry_type {
 | 
			
		||||
	SAFETY_MEMORY_CONFIG_OVERRIDE_WEIGHT = 1,
 | 
			
		||||
	SAFETY_MEMORY_CONFIG_OVERRIDE_PERSISTANCE = 2,
 | 
			
		||||
@@ -120,7 +138,7 @@ struct config_override {
 | 
			
		||||
	union {
 | 
			
		||||
		struct {
 | 
			
		||||
			uint8_t flag;
 | 
			
		||||
			uint8_t weight;
 | 
			
		||||
			enum config_override_weight weight;
 | 
			
		||||
		} weight_override;
 | 
			
		||||
		struct {
 | 
			
		||||
			uint8_t flag;
 | 
			
		||||
@@ -129,26 +147,104 @@ struct config_override {
 | 
			
		||||
	} entry;
 | 
			
		||||
};
 | 
			
		||||
 | 
			
		||||
/**
 | 
			
		||||
 * @brief First time init the safety memory. This requests all clocks etc.
 | 
			
		||||
 *
 | 
			
		||||
 * The error memory is always vlaid after this function. At least, if it returns without error.
 | 
			
		||||
 * The \p found_state output tells the caller, in which state the memory was found. If it was uninitialized,
 | 
			
		||||
 * or corrupted, it is completely wiped and a fresh memory structure is written.
 | 
			
		||||
 *
 | 
			
		||||
 * @param[out] found_state State the error memory was found in
 | 
			
		||||
 * @return 0 if successful
 | 
			
		||||
 * @warning Also check @ref safety_memory_reinit
 | 
			
		||||
 */
 | 
			
		||||
int safety_memory_init(enum safety_memory_state *found_state);
 | 
			
		||||
 | 
			
		||||
/**
 | 
			
		||||
 * @brief Same as @ref safety_memory_init, but without specifically requesting the clock modules.
 | 
			
		||||
 *
 | 
			
		||||
 * Use this, if a call to @ref safety_memory_init has already been done.
 | 
			
		||||
 *
 | 
			
		||||
 * @param[out] found_state State the error memory was found in
 | 
			
		||||
 * @return 0 if successful
 | 
			
		||||
 */
 | 
			
		||||
int safety_memory_reinit(enum safety_memory_state *found_state);
 | 
			
		||||
 | 
			
		||||
/**
 | 
			
		||||
 * @brief Get the boot status structure from safety memory
 | 
			
		||||
 * @param[out] status Status read from memory.
 | 
			
		||||
 * @return 0 if successful
 | 
			
		||||
 */
 | 
			
		||||
int safety_memory_get_boot_status(struct safety_memory_boot_status *status);
 | 
			
		||||
 | 
			
		||||
/**
 | 
			
		||||
 * @brief Write the boot status structure to safety memory
 | 
			
		||||
 * @param[in] status Status to write
 | 
			
		||||
 * @return 0 if successful
 | 
			
		||||
 */
 | 
			
		||||
int safety_memory_set_boot_status(const struct safety_memory_boot_status *status);
 | 
			
		||||
 | 
			
		||||
/**
 | 
			
		||||
 * @brief Get the amout of error entries in the error memory. This also includes NOP entries.
 | 
			
		||||
 * @param[out] count Count
 | 
			
		||||
 * @return 0 if successful
 | 
			
		||||
 */
 | 
			
		||||
int safety_memory_get_error_entry_count(uint32_t *count);
 | 
			
		||||
 | 
			
		||||
/**
 | 
			
		||||
 * @brief Check the header and CRC of the safety memory.
 | 
			
		||||
 * @return 0 if all checks pass
 | 
			
		||||
 */
 | 
			
		||||
int safety_memory_check(void);
 | 
			
		||||
 | 
			
		||||
/**
 | 
			
		||||
 * @brief Read an error entry from the error memory
 | 
			
		||||
 * @param idx Index of the entry
 | 
			
		||||
 * @param[out] entry Error entry
 | 
			
		||||
 * @return 0 if successful
 | 
			
		||||
 */
 | 
			
		||||
int safety_memory_get_error_entry(uint32_t idx, struct error_memory_entry *entry);
 | 
			
		||||
 | 
			
		||||
/**
 | 
			
		||||
 * @brief Insert an error entry
 | 
			
		||||
 *
 | 
			
		||||
 * This function inserts an error entry on the first NOP entry found in the error memory.
 | 
			
		||||
 * If an entry is found with the same flag number, its counter is incremented by the counter value of the
 | 
			
		||||
 * element to insert.
 | 
			
		||||
 *
 | 
			
		||||
 * If there are no NOPs or fitting entries in the error memory, error memory is expanded until it hits the memory
 | 
			
		||||
 * boundary.
 | 
			
		||||
 *
 | 
			
		||||
 * @param entry Error entry to insert
 | 
			
		||||
 * @returns 0 if successful, -3 if out of memory, and other negative error codes
 | 
			
		||||
 */
 | 
			
		||||
int safety_memory_insert_error_entry(struct error_memory_entry *entry);
 | 
			
		||||
 | 
			
		||||
/**
 | 
			
		||||
 * @brief Insert a config override entry at the first free location.
 | 
			
		||||
 *
 | 
			
		||||
 * Free locations are entries containing 0x00000000
 | 
			
		||||
 *
 | 
			
		||||
 * @param config_override Config to write
 | 
			
		||||
 * @return 0 if successful
 | 
			
		||||
 */
 | 
			
		||||
int safety_memory_insert_config_override(struct config_override *config_override);
 | 
			
		||||
 | 
			
		||||
/**
 | 
			
		||||
 * @brief Get count of config overrides
 | 
			
		||||
 * @param[out] count Number of overrides
 | 
			
		||||
 * @return 0 if successful
 | 
			
		||||
 */
 | 
			
		||||
int safety_memory_get_config_override_count(uint32_t *count);
 | 
			
		||||
 | 
			
		||||
/**
 | 
			
		||||
 * @brief Get a config ovveide entry
 | 
			
		||||
 * @param idx Index of the requested entry
 | 
			
		||||
 * @param[out] config_override READ override
 | 
			
		||||
 * @return 0 if successful
 | 
			
		||||
 */
 | 
			
		||||
int safety_memory_get_config_override(uint32_t idx, struct config_override *config_override);
 | 
			
		||||
 | 
			
		||||
#endif /* __SAFETY_MEMORY_H__ */
 | 
			
		||||
 | 
			
		||||
/** @} */
 | 
			
		||||
 
 | 
			
		||||
@@ -218,13 +218,28 @@ int safety_controller_report_error_with_key(enum safety_flag flag, uint32_t key)
 | 
			
		||||
{
 | 
			
		||||
	uint32_t i;
 | 
			
		||||
	int ret = -1;
 | 
			
		||||
	bool old_state;
 | 
			
		||||
	int res;
 | 
			
		||||
	struct error_memory_entry err_mem_entry;
 | 
			
		||||
 | 
			
		||||
	for (i = 0; i < COUNT_OF(flags); i++) {
 | 
			
		||||
		if (flags[i].flag & flag) {
 | 
			
		||||
			old_state = flags[i].error_state;
 | 
			
		||||
			flags[i].error_state = true;
 | 
			
		||||
			flags[i].error_state_inv = !flags[i].error_state;
 | 
			
		||||
			flags[i].key = key;
 | 
			
		||||
			ret = 0;
 | 
			
		||||
 | 
			
		||||
			if (flags[i].persistent && !old_state) {
 | 
			
		||||
				err_mem_entry.counter = 1;
 | 
			
		||||
				err_mem_entry.flag_num = i;
 | 
			
		||||
				err_mem_entry.type = SAFETY_MEMORY_ERR_ENTRY_FLAG;
 | 
			
		||||
				res = safety_memory_insert_error_entry(&err_mem_entry);
 | 
			
		||||
				if (res) {
 | 
			
		||||
					ret = -12;
 | 
			
		||||
				}
 | 
			
		||||
			} else {
 | 
			
		||||
				ret = 0;
 | 
			
		||||
			}
 | 
			
		||||
		}
 | 
			
		||||
	}
 | 
			
		||||
 | 
			
		||||
 
 | 
			
		||||
@@ -107,6 +107,11 @@ return_val:
 | 
			
		||||
	return ret;
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
static void safety_memory_write_header(const struct safety_memory_header *header)
 | 
			
		||||
{
 | 
			
		||||
	backup_ram_write_data(0UL, (uint32_t *)header, wordsize_of(*header));
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
static void safety_memory_write_new_header(void)
 | 
			
		||||
{
 | 
			
		||||
	struct safety_memory_header header;
 | 
			
		||||
@@ -120,7 +125,7 @@ static void safety_memory_write_new_header(void)
 | 
			
		||||
	header.magic_i = ~SAFETY_MEMORY_MAGIC;
 | 
			
		||||
 | 
			
		||||
	backup_ram_wipe();
 | 
			
		||||
	backup_ram_write_data(0UL, (uint32_t *)&header, wordsize_of(header));
 | 
			
		||||
	safety_memory_write_header(&header);
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
static int safety_memory_check_crc()
 | 
			
		||||
@@ -371,7 +376,93 @@ return_value:
 | 
			
		||||
	return ret;
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
int safety_memory_insert_error_entry(struct error_memory_entry *entry);
 | 
			
		||||
int safety_memory_insert_error_entry(struct error_memory_entry *entry)
 | 
			
		||||
{
 | 
			
		||||
	int res;
 | 
			
		||||
	int ret = -0xFFFF;
 | 
			
		||||
	uint32_t addr;
 | 
			
		||||
	uint32_t data;
 | 
			
		||||
	bool found;
 | 
			
		||||
	uint32_t input_data;
 | 
			
		||||
	struct error_memory_entry current_entry;
 | 
			
		||||
 | 
			
		||||
	struct safety_memory_header header;
 | 
			
		||||
 | 
			
		||||
	input_data = error_memory_entry_to_word(entry);
 | 
			
		||||
 | 
			
		||||
	if (safety_memory_get_header(&header) != SAFETY_MEMORY_INIT_VALID_MEMORY) {
 | 
			
		||||
		return -2000;
 | 
			
		||||
	}
 | 
			
		||||
 | 
			
		||||
	if (entry->type == SAFETY_MEMORY_ERR_ENTRY_NOP) {
 | 
			
		||||
		/* Append to end */
 | 
			
		||||
		if ((header.err_memory_end + 1U) < backup_ram_get_size_in_words()) {
 | 
			
		||||
			/* Still fits in memory */
 | 
			
		||||
			backup_ram_write_data(header.err_memory_end, &input_data, 1UL);
 | 
			
		||||
			header.err_memory_end++;
 | 
			
		||||
			safety_memory_write_header(&header);
 | 
			
		||||
			safety_memory_gen_crc();
 | 
			
		||||
			ret = 0;
 | 
			
		||||
		}
 | 
			
		||||
	} else if (entry->type == SAFETY_MEMORY_ERR_ENTRY_FLAG) {
 | 
			
		||||
		found = false;
 | 
			
		||||
		for (addr = header.err_memory_offset; addr < header.err_memory_end; addr++) {
 | 
			
		||||
			res = backup_ram_get_data(addr, &data, 1UL);
 | 
			
		||||
			if (res) {
 | 
			
		||||
				ret = -1;
 | 
			
		||||
				goto return_value;
 | 
			
		||||
			}
 | 
			
		||||
			res = word_to_error_memory_entry(data, ¤t_entry);
 | 
			
		||||
			if (res) {
 | 
			
		||||
				ret = -2;
 | 
			
		||||
				goto return_value;
 | 
			
		||||
			}
 | 
			
		||||
 | 
			
		||||
			if (current_entry.type == SAFETY_MEMORY_ERR_ENTRY_FLAG &&
 | 
			
		||||
					current_entry.flag_num == entry->flag_num) {
 | 
			
		||||
				found = true;
 | 
			
		||||
				break;
 | 
			
		||||
			}
 | 
			
		||||
 | 
			
		||||
			if (current_entry.type == SAFETY_MEMORY_ERR_ENTRY_NOP) {
 | 
			
		||||
				found = true;
 | 
			
		||||
				break;
 | 
			
		||||
			}
 | 
			
		||||
		}
 | 
			
		||||
 | 
			
		||||
		if (!found) {
 | 
			
		||||
			/* No suitable place found in memory. Append */
 | 
			
		||||
 | 
			
		||||
			if ((addr + 1) < backup_ram_get_size_in_words()) {
 | 
			
		||||
				backup_ram_write_data(addr, &input_data, 1UL);
 | 
			
		||||
				header.err_memory_end++;
 | 
			
		||||
				safety_memory_write_header(&header);
 | 
			
		||||
			} else {
 | 
			
		||||
				ret = -3;
 | 
			
		||||
				goto return_value;
 | 
			
		||||
			}
 | 
			
		||||
		} else {
 | 
			
		||||
			if (current_entry.type == SAFETY_MEMORY_ERR_ENTRY_NOP) {
 | 
			
		||||
				backup_ram_write_data(addr, &input_data, 1UL);
 | 
			
		||||
			} else {
 | 
			
		||||
				current_entry.counter += entry->counter;
 | 
			
		||||
				if (current_entry.counter < entry->counter)
 | 
			
		||||
					current_entry.counter = 0xFFFF;
 | 
			
		||||
				data = error_memory_entry_to_word(¤t_entry);
 | 
			
		||||
				backup_ram_write_data(addr, &data, 1UL);
 | 
			
		||||
			}
 | 
			
		||||
		}
 | 
			
		||||
 | 
			
		||||
		safety_memory_gen_crc();
 | 
			
		||||
		ret = 0;
 | 
			
		||||
 | 
			
		||||
	} else {
 | 
			
		||||
		ret = -1001;
 | 
			
		||||
	}
 | 
			
		||||
 | 
			
		||||
return_value:
 | 
			
		||||
	return ret;
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
int safety_memory_insert_config_override(struct config_override *config_override);
 | 
			
		||||
 | 
			
		||||
 
 | 
			
		||||
		Reference in New Issue
	
	Block a user