bms/Application/app/iap.c

#include <string.h>
#include "app/iap.h"
#include "bsp/fmc_flash.h"

#define QWS_IAP_MAGIC_SUCCESS		0x11223344
#define QWS_IAP_MAGIC_FLASH			0xAABBCCDD

static int iap_write_image(uint8_t *data, int len);
static int iap_check_image(uint8_t *data, int len);
static void _reboot_timer_handler(shark_timer_t *t);
void iap_read_string(can_frame_t *frame);

static int _write_position = 0;
static shark_timer_t _reboot_timer = {.handler = _reboot_timer_handler,};

void process_iap_message(can_frame_t *frame, int len){
	uint8_t *data = NULL;
	int data_len = 0;
	switch(frame->key) {
		case CAN_KEY_IAP_ENTER:
			protocol_send_ack(frame->head.can_addr, frame->key, 0);
			break;
		case CAN_KEY_IAP_BEGIN:
			fmc_erase_image();
			_write_position = 0;
			protocol_send_ack(frame->head.can_addr, frame->key, 0);
			break;
		case CAN_KEY_IAP_WRITE:
			data_len = iap_write_image(frame->data, len);
			data = frame->data;
			break;
		case CAN_KEY_IAP_CHECK:
			data_len = iap_check_image(frame->data, len);
			data = frame->data;
			break;
		case CAN_KEY_IAP_BOOT:
			protocol_send_ack(frame->head.can_addr, frame->key, 0);
			shark_timer_post(&_reboot_timer,1000);
			break;
		case CAN_EEY_IAP_READ_STRING:
			iap_read_string(frame);
			break;
	}
	if (data != NULL && data_len > 0){
		protocol_send_bms_info(frame->head.can_addr, frame->key, frame->data, data_len);
	}
}

static void _reboot_timer_handler(shark_timer_t *t){
	NVIC_SystemReset();
}

static int iap_write_image(uint8_t *data, int len){
	int w_pos = shark_decode_u24(data);
	if (w_pos == _write_position) {
		fmc_write_image(data + 3, len - 3);
		_write_position += w_pos;
	}
	shark_encode_u24(data, w_pos);
	return 3;
}

void iap_read_string(can_frame_t *frame)
{
	uint8_t buff[64];
	const char *text;
	uint32_t addr;
	uint32_t len;

	addr = ((uint32_t) frame->data[2]) << 16 | ((uint32_t) frame->data[1]) << 8 | frame->data[0];
	text = (const char *) (0x08000000 + addr);

	len = strlen(text);
	if (len > (sizeof(buff)-4)) {
		len = sizeof(buff) - 4;
	}
	buff[0] = 0;
	memcpy(buff+1, frame->data, 3);
	memcpy(buff + 4, text, len);

	protocol_send_bms_info(frame->head.can_addr, frame->key, buff, len + 4);
}


static int iap_check_image(uint8_t *data, int len) {
	uint32_t size, checksum;
	size = shark_decode_u24(data);
	checksum = shark_decode_u32(data + 3);
	uint32_t d_checksum = shark_iap_checksum_init();
	d_checksum = shark_iap_checksum_put(d_checksum, (const u8 *)fmc_iap_image_addr(), size);
	d_checksum = shark_iap_checksum_finish(d_checksum);

	if (checksum != d_checksum) {
		data[0] = 1;
		return 1;
	}
	fmc_write_magic(size, checksum, QWS_IAP_MAGIC_FLASH);
	data[0] = 0;
	return 1;	
}