384 lines
9.0 KiB
C
384 lines
9.0 KiB
C
#include "awtk.h"
|
||
#include "user_protocol.h"
|
||
#include "gpio_protocol.h"
|
||
#include "moto_config.h"
|
||
#include "data_port.h"
|
||
|
||
#include "FreeRTOS.h"
|
||
#include "chip.h"
|
||
#include "board.h"
|
||
#include "keypad.h"
|
||
#include "moto_adc.h"
|
||
|
||
|
||
uint8_t save_data = 0;
|
||
|
||
#define ADC_VPLTAGE_MIN 1666
|
||
#define ADC_VPLTAGE_MAX 2486
|
||
|
||
int adc_light = 0;
|
||
int adc_voltage = 0;
|
||
|
||
extern uint32_t fml_stamp_to_time(uint32_t timep , uint32_t time[]);
|
||
extern uint8_t light_buffer[];
|
||
extern double cell_buffer[];
|
||
extern uint8_t data_storage;
|
||
extern uint32_t tire_front_time;
|
||
extern uint32_t tire_rear_time;
|
||
|
||
// 封装的函数，根据位位置获取对应的值
|
||
uint8_t getBitValue(uint8_t count, int bitPosition) {
|
||
return (count >> bitPosition) & 0x1;
|
||
}
|
||
// 封装的函数，获取2个bit组合成的值
|
||
uint8_t getBit2Value(uint8_t count, int bitPosition) {
|
||
return (count >> bitPosition) & 0x3;
|
||
}
|
||
|
||
// 封装的函数，获取3个bit组合成的值
|
||
uint8_t getBit3Value(uint8_t count, int bitPosition) {
|
||
return (count >> bitPosition) & 0x7;
|
||
}
|
||
|
||
// 封装的函数，获取4个bit组合成的值
|
||
uint8_t getBit4Value(uint8_t count, int bitPosition) {
|
||
return (count >> bitPosition) & 0xf;
|
||
}
|
||
|
||
double adc_voltage_calculation(void){
|
||
double value = 0;
|
||
|
||
if(adc_voltage<=ADC_VPLTAGE_MIN)
|
||
value = 11.0;
|
||
else if(adc_voltage>=ADC_VPLTAGE_MAX)
|
||
value = 16.5;
|
||
else
|
||
value = (adc_voltage - ADC_VPLTAGE_MIN) * (16.5 - 11.0) / (ADC_VPLTAGE_MAX - ADC_VPLTAGE_MIN) + 11.0;
|
||
// printf("adc_voltage = %d value = %lf.\r\n",adc_voltage,value);
|
||
return value;
|
||
}
|
||
|
||
//MOTO通讯 设备信息+时间戳解析协议
|
||
void device_data_analysis(uint8_t *buf){
|
||
DEBUG_PRINT("enter device_data_analysis .\r\n");
|
||
uint8_t data;
|
||
uint8_t sum1,sum2,sum3,sum4;
|
||
uint32_t sum;
|
||
uint8_t i=0;
|
||
char equipment[16] = {0};
|
||
char produce[5] = {0};
|
||
char mac[6] = {0};
|
||
data = *(buf++);
|
||
// DEBUG_PRINT("0xAA -- %02x .\n",data);
|
||
if(data!=0xAA)
|
||
return;
|
||
|
||
data = *(buf++);
|
||
// DEBUG_PRINT("0x47 -- %02x .\n",data);
|
||
if(data!=0x47)
|
||
return;
|
||
|
||
//设备相关信息
|
||
data = *(buf++);//0x01
|
||
// DEBUG_PRINT("0x01 -- %02x .\n",data);
|
||
data = *(buf++);//0x1C 总长度22+6mac
|
||
// DEBUG_PRINT("0x1c -- %02x .\n",data);
|
||
//设备编号占16
|
||
DEBUG_PRINT("equipment > ");
|
||
for(i=0;i<16;i++){
|
||
data = *(buf++);//0x16
|
||
DEBUG_PRINT("%02x ",data);
|
||
equipment[i] = data;
|
||
}
|
||
DEBUG_PRINT("\n");
|
||
Set_device_equipment_num(equipment);
|
||
//产品型号占5
|
||
DEBUG_PRINT("produce > ");
|
||
for(i=0;i<5;i++){
|
||
data = *(buf++);
|
||
DEBUG_PRINT("%02x ",data);
|
||
produce[i] = data;
|
||
}
|
||
DEBUG_PRINT("\n");
|
||
Set_device_produce_num(produce);
|
||
//客户编号
|
||
data = *(buf++);
|
||
DEBUG_PRINT("client > %02x \n",data);
|
||
Set_device_client_num(data);
|
||
//mac占6
|
||
DEBUG_PRINT("mac > ");
|
||
for(i=0;i<6;i++){
|
||
data = *(buf++);
|
||
DEBUG_PRINT("%02x ",data);
|
||
mac[i] = data;
|
||
}
|
||
DEBUG_PRINT("\n");
|
||
Set_device_mac(mac);
|
||
|
||
//平台信息
|
||
data = *(buf++);//0x02
|
||
// DEBUG_PRINT("0x02 -- %02x .\n",data);
|
||
data = *(buf++);//0x03
|
||
// DEBUG_PRINT("0x03 -- %02x .\n",data);
|
||
//BottomData platform[3];
|
||
data = *(buf++);//平台ID
|
||
DEBUG_PRINT("bottom_id > %02x \n",data);
|
||
Set_device_bottom_id(data);
|
||
|
||
data = *(buf++);//主版本
|
||
DEBUG_PRINT("bottom_softwar_host > %02x \n",data);
|
||
Set_device_bottom_softwar_host(data);
|
||
|
||
data = *(buf++);//次版本
|
||
DEBUG_PRINT("bottom_softwar_order > %02x \n",data);
|
||
Set_device_bottom_softwar_order(data);
|
||
//Set_device_bottom_data(platform);
|
||
|
||
|
||
//平台认证
|
||
data = *(buf++);//0x03
|
||
DEBUG_PRINT("0x03 -- %02x .\n",data);
|
||
data = *(buf++);//0x14
|
||
DEBUG_PRINT("0x14 -- %02x .\n",data);
|
||
DEBUG_PRINT("voucher > ");
|
||
char voucher[20] = {0};
|
||
for(i=0;i<20;i++){
|
||
data = *(buf++);
|
||
DEBUG_PRINT("%02x ",data);
|
||
voucher[i] = data;
|
||
}
|
||
DEBUG_PRINT("\n");
|
||
Set_device_voucher(voucher);
|
||
|
||
|
||
//同步时间
|
||
data = *(buf++);//0x04
|
||
// printf("time >> 0x04 -- %02x .\n",data);
|
||
data = *(buf++);//0x04
|
||
// printf("time >> 0x04 -- %02x .\n",data);
|
||
//DEBUG_PRINT("time stamp >> ");
|
||
uint32_t time_transfer[6];
|
||
|
||
sum1 = *(buf++);
|
||
sum2 = *(buf++);
|
||
sum3 = *(buf++);
|
||
sum4 = *(buf++);
|
||
|
||
//sum = sum1 | sum2<<8 | sum3<<16 | sum4<<24;
|
||
sum = sum1<<24 | sum2<<16 | sum3<<8 | sum4;
|
||
// printf("time > %08x \n",sum);
|
||
tire_rear_time = sum;
|
||
tire_front_time = sum;
|
||
// if(sum<1706198400)
|
||
// sum = 1706198400;
|
||
fml_stamp_to_time(sum,time_transfer);
|
||
// printf(">>>>>>>>>>>>>>>>>>>>>>>>>>>>>>>>>>>>>>>>>\n");
|
||
|
||
// Uart_set_time(time_transfer);//去设置时间并不再发送询问时间指令
|
||
//Set_sys_ttrb_time(10);
|
||
|
||
data = *(buf++);//0x05
|
||
//DEBUG_PRINT("0x05 -- %02x .\n",data);
|
||
data = *(buf++);//0x02
|
||
//DEBUG_PRINT("0x02 -- %02x .\n",data);
|
||
data = *(buf++);
|
||
DEBUG_PRINT("device_moto_type %02x \n",data);
|
||
Set_device_moto_type(data);
|
||
data = *(buf++);
|
||
DEBUG_PRINT("device_screen_type %02x \n",data);
|
||
Set_device_screen_type(data);
|
||
|
||
|
||
data = *(buf++);//0x06
|
||
//DEBUG_PRINT("0x06 -- %02x .\n",data);
|
||
data = *(buf++);//0x01
|
||
//DEBUG_PRINT("0x01 -- %02x .\n",data);
|
||
data = *(buf++);
|
||
DEBUG_PRINT("device_ability %02x .\n",data);
|
||
Set_device_ability(data);
|
||
|
||
}
|
||
int test_light = 0;
|
||
//MOTO通讯协议
|
||
void data_analysis(uint8_t *buf){
|
||
uint32_t data;
|
||
uint32_t sum,sum1,sum2,sum3,sum4;
|
||
volatile double value=0;
|
||
//一些标志
|
||
uint8_t temp = 0;
|
||
uint8_t oil = 0;
|
||
uint8_t light = 0;
|
||
double cell = 0;
|
||
uint8_t sys_state = 0;
|
||
save_data = 0;
|
||
|
||
if(Get_sys_power_on_self_test()==100)
|
||
sys_state=1;
|
||
|
||
data = *(buf++);
|
||
if(data!=0xAA)
|
||
return;
|
||
|
||
data = *(buf++);
|
||
if(data!=0x18)
|
||
return;
|
||
|
||
data = *(buf++);
|
||
if(data!=0x03)
|
||
return;
|
||
|
||
|
||
data = *(buf++);
|
||
if(data!=0x50)
|
||
return;
|
||
|
||
data = *(buf++);
|
||
if(data!=0x14)
|
||
return;
|
||
|
||
//速度
|
||
data = *(buf++);
|
||
#ifndef SPEED_DATA_CAN
|
||
Set_sys_velocity(data);
|
||
#endif
|
||
|
||
//转速
|
||
sum = 0;
|
||
sum = *(buf++)&0xFF;
|
||
//sum = (*(buf++)&0xFF)<<8 | sum;
|
||
sum = (*(buf++)&0xFF) | sum<<8;
|
||
Set_sys_veer_velocity(sum);
|
||
|
||
//小计里程
|
||
sum = 0;
|
||
sum1 = *(buf++)&0xFF;
|
||
sum2 = *(buf++)&0xFF;
|
||
sum3 = *(buf++)&0xFF;
|
||
sum4 = *(buf++)&0xFF;
|
||
sum = sum1<<24 | sum2<<16 | sum3<<8 | sum4;
|
||
Set_sys_trip_mileage(sum);
|
||
|
||
//总计里程
|
||
sum = 0;
|
||
sum1 = *(buf++)&0xFF;
|
||
sum2 = *(buf++)&0xFF;
|
||
sum3 = *(buf++)&0xFF;
|
||
sum4 = *(buf++)&0xFF;
|
||
sum = sum1<<24 | sum2<<16 | sum3<<8 | sum4;
|
||
Set_sys_total_mileage(sum);
|
||
|
||
//灯1
|
||
data = *(buf++);
|
||
// DEBUG_PRINT("data = %d .\r\n",data);
|
||
Set_sys_veer(getBit2Value(data,0));//UI层数据
|
||
Set_sys_lamplight(getBitValue(data,2));
|
||
Set_sys_side_marker(getBitValue(data,3));
|
||
Set_sys_warning_abs(getBitValue(data,4));
|
||
Set_sys_warning_tcs(getBitValue(data,5));
|
||
Set_sys_warning_engine(getBitValue(data,6));
|
||
save_data = getBitValue(data,7);
|
||
|
||
if(sys_state){
|
||
right_led_switch(getBitValue(data,0));
|
||
left_led_switch(getBitValue(data,1));
|
||
yg_led_switch(getBitValue(data,2));
|
||
#if (MOTO_WARE_HOSE == MOTO_ICMX_A580A)
|
||
abs_led_switch(getBitValue(data,4));
|
||
eng_led_switch(getBitValue(data,6));
|
||
#endif
|
||
|
||
}
|
||
|
||
//档位
|
||
data = *(buf++);
|
||
if(data < 8){
|
||
Set_sys_grade(data);
|
||
if(sys_state){
|
||
if(data == 0)
|
||
n_led_switch(1);
|
||
else
|
||
n_led_switch(0);
|
||
}
|
||
}
|
||
|
||
//油量
|
||
oil = *(buf++);
|
||
|
||
//温度
|
||
temp = *(buf++);
|
||
|
||
//电池电压
|
||
value = 0;
|
||
sum = *(buf++)&0xFF;
|
||
value = (*(buf++)&0xFF) | sum<<8;
|
||
cell = value/1000;
|
||
|
||
//光感阻值 测试范围：57-1000
|
||
sum = 0;
|
||
sum = *(buf++)&0xFF;
|
||
sum = (*(buf++)&0xFF) | sum<<8;
|
||
// Set_sys_sensor_light(sum);
|
||
// if(sum<215)
|
||
// light = sum/2;
|
||
// else
|
||
// light = 215;
|
||
|
||
data = *(buf++);
|
||
if(JUDGE_BIN_0(data)){//收到小计清零，不再发送
|
||
DEBUG_PRINT("Received subtotal reset, no more sending.\n");
|
||
Set_sys_odo_reset(10);
|
||
}
|
||
if(JUDGE_BIN_1(data)){//需要询问时间
|
||
DEBUG_PRINT("start time select.\n");
|
||
Set_sys_ttrb(0);
|
||
}
|
||
if(JUDGE_BIN_2(data)){//收到故障码，不再发送
|
||
DEBUG_PRINT("Received fault code, no longer sending.\n");
|
||
Set_sys_fault_code(0);
|
||
}
|
||
if(JUDGE_BIN_3(data)){//收到时间，不再发送
|
||
DEBUG_PRINT("Received time, no longer sending.\n");
|
||
Set_sys_ttrb_time(10);//630发送时间给蓝牙后，蓝牙回复收到信号
|
||
}
|
||
if(JUDGE_BIN_4(data)){//收到小计清零，不再发送
|
||
DEBUG_PRINT("Received tire pressure command, no longer sending.\n");
|
||
Set_sys_tire_pressure_mesg(10);
|
||
}
|
||
|
||
if(save_data){
|
||
// DEBUG_PRINT("save_data.\r\n");
|
||
// printf("light = %d .\r\n",light);
|
||
Set_sys_gas(oil);
|
||
Set_sys_temp(temp);
|
||
//Set_sys_voltage(cell);
|
||
// light = light-15;
|
||
// light_buffer[data_storage] = light;
|
||
|
||
//adc采样电压计算
|
||
// if(adc_voltage>=1700){
|
||
// cell = adc_voltage_calculation();
|
||
// Set_sys_voltage(cell);
|
||
|
||
adc_light = adc_get_channel_value(ADC_CH_AUX2);//光感
|
||
adc_voltage = adc_get_channel_value(ADC_CH_AUX3);//电压
|
||
cell = adc_voltage_calculation();
|
||
cell_buffer[data_storage] = cell;
|
||
// Set_sys_voltage(cell);
|
||
|
||
//adc采样光感计算
|
||
int light_num = (adc_light/10);
|
||
test_light = light_num;
|
||
if(light_num>=200)
|
||
light_num = 200;
|
||
if(Get_sys_power_on_self_test()<100)
|
||
light_num = 10;
|
||
light_buffer[data_storage] =light_num;
|
||
data_storage++;
|
||
if(data_storage>=SAVE_DATA_SIZE){//满足存储大小 计算均值
|
||
data_storage=0;
|
||
}
|
||
}
|
||
|
||
}
|
||
|