motor_bootloader/bin_check.c

#include "bin_check.h"
#include <string.h>

unsigned char Check_UUID[16] = {0xae, 0x7a, 0xe5, 0x01, 0xb6, 0xb2, 0x4b, 0x67, 0x87, 0x58, 0xd8, 0x6c, 0x69, 0xe8, 0xe5, 0xfe};
unsigned char DES_Key1[8] = "MOTINOVA";
unsigned char DES_Key2[8] = "AVONITOM";
	
//全局变量
unsigned char CheckFlag = 0;         //检验标志，0-初始状态，1-进入检验，2-检验合格，3-检验异常
unsigned char Crc32_Cal[4];          //根据文件头计算的CRC32
unsigned char *CheckInfo;            //校验文件信息指针，不分配空间，指向第一包数据

//全局函数
//比较文件头
char Check_CompareHead(unsigned char* Head, unsigned char* UUID)
{
  char Result = 0;
  
	for(int i = 0; i< 16; i++)
	{
	  if(*(Head + i) - UUID[i] == 0)
		{
		  continue;
		}
		else
		{
		  Result = -1;
			break;
		}
	}
	
	return Result;
}

//计算获取bin文件crc32
void Check_CalCrc32(unsigned char* Input, unsigned char* Result)
{
  unsigned char CalRes[8];
	des(Input + 48, DES_Key1, 1, CalRes);
	memcpy(Result, CalRes, 4);
}

//比较加密数据
char Check_CompareEncryptInfo(unsigned char* Input)
{
  char Result = 0;
  unsigned char CalRes[8];
	des(Input + 48, DES_Key2, 0, CalRes);
	for(int i = 0; i< 8; i++)
	{
	  if(*(CalRes + i) - *(Input + 48 + 8 + i) == 0)
		{
		  continue;
		}
		else
		{
		  Result = -1;
			break;
		}
	}
		
	return Result;
}

//比较自定义信息
char Check_OptionInfo(unsigned char* Input, unsigned int SaveInfoAddress)
{
  char Result = 0;
	unsigned char OptionSave[32];
	unsigned int DataTemp32 = 0;
  
	//读取存储的boot自定义位
	for(int i = 0; i < 8; i++)
	{
	  DataTemp32 = *(volatile unsigned int*)(SaveInfoAddress + i * 4);
		OptionSave[4 * i] = (unsigned char)((DataTemp32 >> 24) & 0xFF);
		OptionSave[4 * i + 1] = (unsigned char)((DataTemp32 >> 16) & 0xFF);
		OptionSave[4 * i + 2] = (unsigned char)((DataTemp32 >> 8) & 0xFF);
		OptionSave[4 * i + 3] = (unsigned char)(DataTemp32 & 0xFF);		
	}
  //按字节比较
	for(int i = 0; i < 32; i++)
	{
	  if(*(Input + 80 + i) - *(OptionSave + i) == 0)
		{
		  continue;
		}
		else
		{
		  Result = -1;
			break;
		}
	}
		
	return Result;
}

//读取产品型号
void Check_ReadPdName(unsigned char* Input, unsigned char* Result, unsigned char Len)
{
  memcpy(Result, Input + 16, Len);
}

//读取版本信息
void Check_ReadVerInfo(unsigned char* Input, unsigned char* Result, unsigned char Len)
{
  memcpy(Result, Input + 32, Len);
}

//比较校验信息
char Check_CompareXor(unsigned char* Input)
{
  char Result = 0, Xor;

	for(int i = 0; i< 16; i++)
	{
	  Xor = 0;
		for(int j = 0; j< 7; j++)
		{
		  Xor ^= *(Input + 16 * j + i);
		}
		if(Xor - *(Input + 112 + i) == 0)
		{
		  continue;
		}
		else
		{
		  Result = -1;
			break;
		}
	}
	
	return Result;
}