/// <summary> /// 电机控制器1 状态反馈第5帧 版本 /// ID:0x1856D0D1 /// 波特率:250Kbps /// 数据长度:8bytes /// 周期:50ms /// </summary> Scm_MCU1_Frame5 ByteToScmMcu1Frame5(CanStandardData scmCanByte5) { Scm_MCU1_Frame5 scmMcu5 = new Scm_MCU1_Frame5(); scmMcu5.sys_type_isg = scmCanByte5.datas[0]; scmMcu5.mcu_type_isg = scmCanByte5.datas[1]; scmMcu5.soft_rev_isg = scmCanByte5.datas[2]; scmMcu5.cmc_pro_ver_isg = scmCanByte5.datas[3]; scmMcu5.rating_data_isg = new byte[] { scmCanByte5.datas[4], scmCanByte5.datas[5] }; return(scmMcu5); }
/// <summary> /// 接收数据并处理 /// </summary> /// <param name="canRecDatas"></param> public override ScmCanReceiveMsg TransformEcuReceiveData(CanStandardData canRecDatas) { uint rec = CanDataFilterById(canRecDatas); ScmCanReceiveMsg recMsg = new ScmCanReceiveMsg(); //若是ID被筛选,则推送筛选ID if (rec != 0xffffffff) //筛选id { return(null); } //ID未被筛选 recMsg.canId = canRecDatas.canId; recMsg.baudrate = canRecDatas.baudrate; recMsg.datas = canRecDatas.datas; switch (canRecDatas.canId) { case Scm_MCU1_Frame1.canId: // 0x0C62D0D1: //反馈第一帧,使能,方向,扭矩,转速 { Scm_MCU1_Frame1 scmMcu1 = ByteToScmMcu1Frame1(canRecDatas); //电机使能 recMsg.containFeedBkMcuEnable = true; recMsg.FeedBkMcuEnable = scmMcu1.isg_ena_act == 1 ? false : true; //工作模式 recMsg.containFeedBkMtclMode = true; switch (scmMcu1.isg_ctrl_mod_act) { case 0: recMsg.FeedBkMtclMode = Ecm_WorkMode.None; break; //初始化 case 1: recMsg.FeedBkMtclMode = Ecm_WorkMode.None; break; //低压上电正常 case 2: recMsg.FeedBkMtclMode = Ecm_WorkMode.None; break; //保留 case 3: recMsg.FeedBkMtclMode = Ecm_WorkMode.None; break; //电机允许运行 case 4: recMsg.FeedBkMtclMode = Ecm_WorkMode.SpeedMode; break; //转速环 case 5: recMsg.FeedBkMtclMode = Ecm_WorkMode.TorqueMode; break; //转矩环 case 6: recMsg.FeedBkMtclMode = Ecm_WorkMode.None; break; //下强电 case 7: recMsg.FeedBkMtclMode = Ecm_WorkMode.None; break; //下弱电 case 8: recMsg.FeedBkMtclMode = Ecm_WorkMode.ErrorProtected; break; //故障 default: break; } recMsg.containFeedBkGear = true; switch (scmMcu1.isg_run_dir_act) { case 0: recMsg.FeedBkGear = Ecm_Gear.NeutralGear; break; //空档 case 1: recMsg.FeedBkGear = Ecm_Gear.DriveGear; break; //前进 case 2: recMsg.FeedBkGear = Ecm_Gear.ReverseGear; break; //后退 default: recMsg.FeedBkGear = Ecm_Gear.ErrorGear; break; } //扭矩 recMsg.containFeedBkMotorTorque = true; recMsg.FeedBkMotorTorque = scmMcu1.isg_tq_acu; //转速 recMsg.containFeedBkMotorSpeed = true; recMsg.FeedBkMotorSpeed = scmMcu1.isg_spd_acu; //最大转矩 recMsg.containFeedBkMotorMaxTorque = true; recMsg.FeedbkMotorMaxTorque = scmMcu1.isg_tq_acu_max; break; } case Scm_MCU1_Frame2.canId: // 0x0C63D0D1: //反馈第二帧,故障等级及故障码 { Scm_MCU1_Frame2 scmMcu2 = ByteToScmMcu1Frame2(canRecDatas); //故障等级 recMsg.containFeedBkErrorLevel = true; recMsg.FeedBkErrorLevel = scmMcu2.isg_err_lvl; //故障码 recMsg.containFeedBkErrorCode = true; recMsg.FeedBkErrorCode = new byte[1] { scmMcu2.isg_err_cod }; //故障位 recMsg.containFeedBkErrorBits = true; recMsg.FeedBkErrorBits = new byte[6] { scmMcu2.isg_err_bit1, scmMcu2.isg_err_bit2, (byte)(scmMcu2.isg_err_bit3 & 0xff), (byte)((scmMcu2.isg_err_bit3 >> 8) & 0xff), (byte)((scmMcu2.isg_err_bit3 >> 16) & 0xff), scmMcu2.isg_err_bit4 }; //故障名称 recMsg.containFeedBkErrorStr = true; recMsg.FeedBkErrorStr = ReceiveErrorTransform(recMsg.FeedBkErrorLevel, scmMcu2.isg_err_cod, scmMcu2.isg_err_bit1, scmMcu2.isg_err_bit2, scmMcu2.isg_err_bit3, scmMcu2.isg_err_bit4); break; } case Scm_MCU1_Frame3.canId: // 0x1864D0D1: //反馈第三帧,电流电压 { Scm_MCU1_Frame3 scmMcu3 = ByteToScmMcu1Frame3(canRecDatas); //直流电压 recMsg.containFeedBkDcVoltage = true; recMsg.FeedBkDcVoltage = scmMcu3.isg_dc_u; //直流电流 recMsg.containFeedBkDcCurrent = true; recMsg.FeedBkDcCurrent = scmMcu3.isg_dc_i; //交流电压 recMsg.containFeedBkAcVoltage = true; recMsg.FeedBkAcVoltage = scmMcu3.isg_ac_u; //交流电流 recMsg.containFeedBkAcCurrent = true; recMsg.FeedBkAcCurrent = scmMcu3.isg_ac_i; break; } case Scm_MCU1_Frame4.canId: // 0x1865D0D1: //反馈第四帧,功率、温度 { Scm_MCU1_Frame4 scmMcu4 = ByteToScmMcu1Frame4(canRecDatas); //功率 recMsg.containFeedBkActPower = true; recMsg.FeedBkActPower = scmMcu4.isg_pwr_acu; recMsg.containFeedBkMotorWindingTemp = true; recMsg.FeedBkMotorWindingTemp = scmMcu4.isg_wind_t; recMsg.containFeedBkMtclInvTemp = true; recMsg.FeedBkMtclInvTemp = scmMcu4.isg_inv_t; //isg_bear_t; //isg_life_cyc; break; } case Scm_MCU1_Frame5.canId: //版本 { Scm_MCU1_Frame5 scmMcu5 = ByteToScmMcu1Frame5(canRecDatas); recMsg.containFeekBkMtclVersion = true; recMsg.FeekBkMtclVersion = scmMcu5.sys_type_isg.ToString("X2") + "." + scmMcu5.mcu_type_isg.ToString("X2") + "." + scmMcu5.soft_rev_isg.ToString("X2") + "." + scmMcu5.cmc_pro_ver_isg.ToString("X2") + "." + scmMcu5.rating_data_isg[0].ToString("X2") + scmMcu5.rating_data_isg[1].ToString("X2"); break; } default: //continue; //其他ID的数据一律不接收 break; } return(recMsg); //推送数据 }