harmony_car/subject-two
harmony_car/subject-two
4
0
Fork 3
Code Issues Pull Requests Packages Projects 1 Releases 45 Wiki Activity
subject-two/entry/src/main/cpp/sdk/judge/sub3/Sub3Judge11Kbtc.cpp

1632 lines
54 KiB
C++
Raw Normal View History

c++代码添加
2025-03-26 17:01:46 +08:00
#include "Sub3Judge11Kbtc.h"
#include "HFactory.h"
Sub3Judge11Kbtc::Sub3Judge11Kbtc()
{
m_exam = __NEW__(TKM3Item);
}
Sub3Judge11Kbtc::~Sub3Judge11Kbtc()
{
__DELETE__(m_exam);
}
bool Sub3Judge11Kbtc::dealJudgeEnter()
{
if(m_exam->TestPro != ItemProFlagInit) return false;
//if(!m_car->rtkEnabled() || !m_car->rtkEnabled(1)) return false;
const TChuanGan* cg = m_car->historyChuanGan();
const std::string& ksdd = TableSysSet->get211();
m_car->setPubCanJudge_XiHuoFlag(true);
m_car->setPubKaoBianTCFinish_LJJL(0);
m_itemv = TSub3Item11Kbtc();
//得到靠边停车的项目距离
const std::vector<std::string>& s505 = TableSysSet->asArray505();
m_itemv.parm_xmjl = s505.size() > 5 && s505[5] != "" ? std::atoi(s505[5].c_str()) : 150; //strtointdef(getdotstr(6, sysset[505], ','), 150);
//项目设定项目距离
//SysSet[523]:靠边停车按每个项目设定项目距离
const std::vector<std::vector<std::string>>& s523 = TableSysSet->asArray2_523();
if(!s523.empty())
{
for(size_t i = 0; i < s523.size(); i++)
{
const std::vector<std::string>& ss523 = s523[i];
if(ss523.empty()) continue;
const std::string& str1 = ss523.size() > 0 && ss523[0] != "" ? ss523[0] : "";
const std::string& str2 = ss523.size() > 1 && ss523[1] != "" ? ss523[1] : "";
const std::string str = std::to_string(m_exam->ItemNo) + "~" + m_exam->SubName;
if(str1 == str)
{
int xmjl = str2.length() > 0 ? std::atoi(str2.c_str()) : 0;
if(xmjl > 0)
{
m_itemv.parm_xmjl = xmjl;
}
}
}
}
if(IS_C1(m_carType) || IS_C2(m_carType))
{
if(m_itemv.parm_xmjl > 150)
{
m_itemv.parm_xmjl = 150;
}
}
if(ksdd == siteof::njdckm3)
{
m_itemv.parm_xmjl = 350;
}
//靠边停车误差，CM
if(ksdd == siteof::changzhoukm3)
{
m_itemv.kbtcwc = 5;
}
m_itemv.PPFXD = s505.size() > 4 && s505[4] != "" ? std::atoi(s505[4].c_str()) : 1; //strtointdef(getdotstr(5, sysset[505], ','), 1);
m_itemv.parm_Rtk_Ag = s505.size() > 1 && s505[1] != "" ? std::atoi(s505[1].c_str()) : 0; //strtointdef(getdotstr(2, sysset[505], ','), 0); //20151013
//如果设置了角度变化评判方向灯，但是阈值不对，把评判方向灯方式改成：停车时刻
if(m_itemv.PPFXD == 0 && m_itemv.parm_Rtk_Ag <= 0.001)
{
m_itemv.PPFXD = 1;
m_itemv.parm_Rtk_Ag = 0;
}
//打方向灯需要3秒
m_itemv.parm_Fxd3s = 3 * SECOND; //round(strtofloat(readiniparam('综合评判', 'fxdyc3s', '3')) * 1000);
//靠边停车项目总时间
double s505_2 = s505.size() > 2 && s505[2] != "" ? std::atof(s505[2].c_str()) : 0;
m_itemv.parm_ZSj = std::round(s505_2 * SECOND); //round(strtofloatdef(getdotstr(3, sysset[505], ','), 0) * 1000);
//进入时刻的时间
m_itemv.Entet_SJ = cg->tkCnt;
//允许停车时间秒，必须在这个时间内拉手刹陕西汉中、黑龙江省大庆需求
int s505_3 = s505.size() > 3 && s505[3] != "" ? std::atoi(s505[3].c_str()) : 180;
m_itemv.Parm_HanZhong_KBTC_SJ = s505_3 * SECOND; //strtointdef(getdotstr(4, sysset[505], ','), 180) * 1000;
//停车后，多长时间内必须开车门，单位：秒
int s505_8 = s505.size() > 8 && s505[8] != "" ? std::atoi(s505[8].c_str()) : 3600;
m_itemv.Parm_TC_KaiCheMen_ShiJian = s505_8 * SECOND; //strtointdef(getdotstr(9, sysset[505], ','), 3600) * 1000;
//开门后，多长时间，自动进入Status6( 关门处理阶段)
m_itemv.parm_KaiMen_Status6 = 15;
//特殊地点版本处理
if(ksdd == siteof::shanghaikm3 && IS_C5(m_carType))
{
m_itemv.parm_KaiMen_Status6 = 210;
}
//大车夜考相关的 大车夜间模式，0：不启用 1：启用（不判靠边距离）
TCar* tcar = m_car->getTCar();
if(tcar->Night_ID == true)
{
if(IS_A1A2A3B1B2C6(m_carType))
{
m_itemv.dcykkb = s505.size() > 6 && s505[6] != "" ? std::atoi(s505[6].c_str()) : 0; //strtointdef(getdotstr(7, sysset[505], ','), 0);
}
}
if(Tools::tolower(ksdd) == siteof::chongqingkm3)
{
if(tcar->Night_ID == true)
{
if(IS_A1A2A3B1B2(m_carType))
{
m_itemv.dcykkb = 1;
}
}
}
//允许停车车道，默认0，只能停最右车道，以路边线算距离，如果设置了此参数，则在设置的车道范围内都可以停车，以车道距离来计算。暂时保定地区启用。
m_itemv.Parm_BaoDing_TC_CheDaoJuLi = s505.size() > 7 && s505[7] != "" ? std::atoi(s505[7].c_str()) : 0;
if(m_itemv.Parm_BaoDing_TC_CheDaoJuLi == 0 && (ksdd == siteof::bdgaoyangkm3 || ksdd == siteof::sxbjxc))
{
m_itemv.Parm_BaoDing_TC_CheDaoJuLi = 10;
}
//进入时刻的当前距离，米
m_itemv.Enter_ljjl = cg->ai_ljjl;
//计次，控制语音用的
m_itemv.jscnt = 1;
//ToDo2:生成进项目事件
//ToDo:语言播报-->请靠边停车
m_exam->TestPro = ItemProFlagJudge;
return true;
}
void Sub3Judge11Kbtc::dealJudgeItem()
{
HELP_COST_TIME("");
if(m_exam->TestPro != ItemProFlagJudge) return;
//if(!m_car->rtkEnabled() || !m_car->rtkEnabled(1)) return;
const TChuanGan* cg = m_car->historyChuanGan();
const TSensorInfo& sor = cg->real.sensor;
const std::string& ksdd = TableSysSet->get211();
m_car->setPubCanJudge_XiHuoFlag(m_itemv.Status < 3);
//特殊地区功能1
if(ksdd == siteof::nj || ksdd == siteof::njdckm3)
{
if(cg->tkCnt - m_itemv.Entet_SJ >= 2000 && cg->tkCnt - m_itemv.Entet_SJ < 2600) //(m_car->GetCurrentTick2() - m_itemv.Entet_SJ >= 2000 && m_car->GetCurrentTick2() - m_itemv.Entet_SJ < 2600)
{
m_itemv.Enter_ljjl = cg->ai_ljjl;
}
}
if(ksdd == siteof::nj)
{
TKM3Item* item = m_car->findExamItem(Sub3ItemType05Lkzx); //直行路口
if(item && item->Item_Color == itemStateZk)
{
if(m_itemv.parm_xmjl < 250)
{
m_itemv.parm_xmjl = 250;
}
}
}
//特殊地区功能2
if(ksdd == siteof::hbwh)
{
if(IS_A1A2A3B1B2(m_carType))
{
if(cg->tkCnt - m_itemv.Entet_SJ >= 2000 && cg->tkCnt - m_itemv.Entet_SJ < 3000) //(GetCurrentTick2() - m_itemv.Entet_SJ >= 2000) and (GetCurrentTick2() - m_itemv.Entet_SJ < 3000) then
{
m_itemv.Enter_ljjl = cg->ai_ljjl;
}
}
}
//到达项目距离不停车
if(cg->ai_ljjl - m_itemv.Enter_ljjl > m_itemv.parm_xmjl && cg->move == moveForward)
{
//未按语音指令在规定的距离内停车
JUDGE_MARK_SUB3(11, "41", true); //20160928
m_exam->TestPro = ItemProFlagEnd;
return;
}
//20160613 商丘
if(m_itemv.parm_ZSj > 0)
{
if(cg->tkCnt - m_itemv.Entet_SJ >= m_itemv.parm_ZSj)
{
//不按考试员指令驾驶
JUDGE_MARK_SUB3(11, "45", true);
}
}
//拉手刹前，放松脚刹
if(ksdd == siteof::changzhoukm3)
{
//0-播报语音 1-语音结束，开始评判 到停车前 2-停车了但未确认，可能继续行驶 3-确认停车了 4-下车评判
if(m_itemv.Status == 2 || m_itemv.Status == 3 || m_itemv.Status == 4)
{
const TChuanGan* his1 = m_car->historyChuanGan(1);
const TSensorInfo& sor1 = m_car->historySensor(1);
const TSensorInfo& sor2 = m_car->historySensor(2);
const TSensorInfo& sor3 = m_car->historySensor(3);
const TSensorInfo& sor4 = m_car->historySensor(4);
const TSensorInfo& sor5 = m_car->historySensor(5);
//拉手刹前，脚刹松开了
if(sor.jsc == SNOT && sor1.jsc == SNOT && sor2.jsc == SNOT && sor3.jsc == SNOT && sor4.jsc == SNOT && sor5.jsc == SNOT &&
cg->move == moveStop && his1->move == moveStop && sor.dw == 0)
{
if(sor.ssc == SNOT) //0表示手刹放下 1-表示拉起来状态
{
if(!IS_C2(m_carType))
{
m_itemv.Kf06 = true;
//Mark(11, '06', false);
}
}
}
}
}
else
{
//拉手刹前，脚刹松开了
if(m_itemv.Status == 2 || m_itemv.Status == 3 || m_itemv.Status == 4)
{
const TSensorInfo& sor1 = m_car->historySensor(1);
if(sor.ssc == SYES && sor1.ssc == SNOT)
{
if(sor.jsc == SNOT && sor1.jsc == SNOT)
{
if(!m_itemv.Kf06)
{
m_itemv.Kf06 = true;
//拉紧驻车制动器前放松行车制动踏板
JUDGE_MARK_SUB3(11, "06", false);
}
}
}
}
}
//0-播报语音 1-语音结束，开始评判 到停车前 2-停车了但未确认，可能继续行驶 3-确认停车了 4-下车评判
switch (m_itemv.Status)
{
case 0: DoStatus_0(); break; //语音播报阶段
case 1: DoStatus_1(); break;
case 2: DoStatus_2(); break;
case 3: DoStatus_3(); break; //停车位置已确认，开始评判
case 4: DoStatus_4(); break; //下车过程评判开始
case 5: DoStatus_5(); break; //关门进入下一步动作
case 6: DoStatus_6(); break; //关门后处理
case 100: DoStatus_100(); break; //结束项目处理
default: TASSERT(false, ""); break;
}
char buf[256]= {0};
SafeSprintf(buf, sizeof(buf), JUDGE_UTF8S("ST:%d,距离=%d"), m_itemv.Status, cg->ai_ljjl - m_itemv.Enter_ljjl);
showStatus(buf);
NS3JudgeVision_40601();
NS3JudgeVision_40604();
}
void Sub3Judge11Kbtc::DoStatus_0()
{
bool OKFlag = false;
if(TableSysSet->get211() != siteof::sccdcz)
{
OKFlag = true;
}
else
{
const TChuanGan* cg = m_car->historyChuanGan();
const TChuanGan* his1 = m_car->historyChuanGan(1);
const TChuanGan* his2 = m_car->historyChuanGan(2);
const TChuanGan* his3 = m_car->historyChuanGan(3);
if(cg->move == moveForward && his1->move == moveForward && his2->move == moveForward && his3->move == moveForward)
{
OKFlag = true;
}
}
if(OKFlag == true)
{
const TChuanGan* cg = m_car->historyChuanGan();
const TGpsInfo& gps = cg->real.gps;
//0-播报语音 1-语音结束，开始评判 到停车前 2-停车了但未确认，可能继续行驶 3-确认停车了 4-下车评
m_itemv.Status = 1;
//播报完声音，初始化
m_itemv.Enter_ljjl = cg->ai_ljjl;
m_itemv.Enter_Rtk_Ag = gps.hxj; //20151013
m_itemv.Enter_Tk = cg->tkCnt;
}
}
void Sub3Judge11Kbtc::DoStatus_1()
{
const TChuanGan* cg = m_car->historyChuanGan();
const TChuanGan* his1 = m_car->historyChuanGan(1);
const TSensorInfo& sor = cg->real.sensor;
const TGpsInfo& gps = cg->real.gps;
const std::string& ksdd = TableSysSet->get211();
m_itemv.Kf06 = false; // 20170310
//停车语音提示
//方向灯标志
if(sor.yfxd == SYES && sor.zfxd == SNOT)
{
if(!m_itemv.yfxd)
{
m_itemv.yfxd = true;
m_itemv.yfxd_tk = cg->tkCnt;
}
if(m_itemv.yfxd_tk != 0)
{
if(cg->tkCnt - m_itemv.yfxd_tk > m_itemv.parm_Fxd3s)
{
m_itemv.yfxd3s = true;
}
}
}
else
{
if(!m_itemv.yfxd3s)
{
m_itemv.yfxd_tk = 0;
}
}
if(cg->move == moveForward && his1->move == moveForward)
{
if(m_itemv.PPFXD == 0)
{
double lsjd = 0.0;
if(m_itemv.Enter_Rtk_Ag + m_itemv.parm_Rtk_Ag > 360.0)
{
if(gps.hxj < 90.0)
{
lsjd = std::abs(360 - m_itemv.Enter_Rtk_Ag + gps.hxj);
}
else
{
lsjd = std::abs(gps.hxj - m_itemv.Enter_Rtk_Ag);
}
}
else
{
lsjd = std::abs(gps.hxj - m_itemv.Enter_Rtk_Ag);
}
if(m_itemv.HasJudgeFXD == false)
{
if(std::abs(lsjd) >= m_itemv.parm_Rtk_Ag)
{
m_itemv.HasJudgeFXD = true;
//评判方向灯
if(!m_itemv.yfxd)
{
//停车前不使用转向灯
JUDGE_MARK_SUB3(11, "42", false);
}
else
{
if(!m_itemv.yfxd3s)
{
//方向灯少于3秒
JUDGE_MARK_SUB3(11, "43", false);
}
}
}
}
}
}
//停车进入下一阶段 20171013 排除熄火状态 20171020
if(cg->move == moveStop && his1->move == moveStop) //增加了前一个信号也是停车状态 20140707 20171019
{
if(ksdd == siteof::xjcj_hm && !IS_C2(m_carType) && !IS_C5(m_carType)) //20190215
{
const TSensorInfo& sor = m_car->historySensor(2);
//车辆运行速度和挡位不匹配
if(sor.dw != 1 && sor.dw != 2) //not (lscg[zj(2)].ai_dw in [1, 2]) then
{
JUDGE_MARK_SUB3(14, "02", true);
}
}
// (*
// if(cg.ai_fdjzs > 200) or ((car.kscx = 'C5') or (car.kscx = 'C2')) then
// {
// //m_itemv.zdtc := true;
// }
// *)
//先看505参数 然后看 按430参数确认靠边，确认靠边后再扣
// if(m_itemv.HasJudgeFXD == false)
// {
// m_itemv.HasJudgeFXD = true;
// //评判方向灯
// if(!m_itemv.yfxd)
// {
// //停车前不使用转向灯
// JUDGE_MARK_SUB3(11, "42", false);
// }
// else
// {
// if(!m_itemv.yfxd3s)
// {
// //方向灯少于3秒
// JUDGE_MARK_SUB3(11, "43", false);
// }
// }
// }
m_itemv.Status = 2;
m_itemv.TCZT_Tk = cg->tkCnt;
m_itemv.Enter_Tk = cg->tkCnt; //20151119
//停车拉手刹相关（汉中需求）
m_itemv.tclssjs = cg->tkCnt; //20170223
//停车拉手刹次数
m_itemv.tclsscnt = 0; //20170223
if(!m_itemv.yfxd && sor.yfxd == SYES)
{
m_itemv.yfxd = true;
m_itemv.yfxd_tk = cg->tkCnt;
}
}
}
void Sub3Judge11Kbtc::DoStatus_2()
{
const TChuanGan* cg = m_car->historyChuanGan();
const TSensorInfo& sor = cg->real.sensor;
const TChuanGan* his1 = m_car->historyChuanGan(1);
const TSensorInfo& sor1 = his1->real.sensor;
const std::string& ksdd = TableSysSet->get211();
//特殊地点版本处理
if(ksdd == siteof::shanghaikm3)
{
//方向灯标志
if(!m_itemv.yfxd && sor.yfxd == SYES)
{
m_itemv.yfxd = true;
m_itemv.yfxd_tk = cg->tkCnt;
}
if(m_itemv.yfxd == true && m_itemv.yfxd3s == false && cg->tkCnt - m_itemv.yfxd_tk >= m_itemv.parm_Fxd3s && sor.yfxd == SYES)
{
m_itemv.yfxd3s = true;
}
}
//靠边停车评判距离的次数
m_itemv.kbtccs = 0; //20180317
//20171030
//靠边停车确认停车条件（0-拉手刹放空挡或拉手刹动作或开车门或解开安全带 1-拉手刹同时置空档 2-停车就判 3-开车门才判）
const std::string& s430 = TableSysSet->get430();
if(s430 == "2")
{
m_itemv.Status = 3;
return;
}
//特殊地点处理2
if(ksdd == siteof::linxiahz)
{
const TChuanGan* his2 = m_car->historyChuanGan(2);
const TChuanGan* his3 = m_car->historyChuanGan(3);
const TChuanGan* his4 = m_car->historyChuanGan(4);
const TChuanGan* his5 = m_car->historyChuanGan(5);
const TChuanGan* his6 = m_car->historyChuanGan(6);
if(cg->move == moveBackward && (sor.dw < 1 || sor.dw > 5) &&
his1->move == moveBackward && his2->move == moveBackward &&
his3->move == moveBackward && his4->move == moveBackward &&
his5->move != moveBackward && his6->move != moveBackward)
{
JUDGE_MARK_SUB3(11, "45", false);
}
}
if(cg->move == moveForward && his1->move == moveForward)
{
const std::vector<std::string>& s505 = TableSysSet->asArray505();
int s505_9 = s505.size() > 9 && s505[9] != "" ? std::atoi(s505[9].c_str()) : 0;
if(ksdd == siteof::sccdcz || ksdd == siteof::ankang)
{
//在前后无干扰条件下停车后，再次挪动车辆
JUDGE_MARK_SUB3(11, "11", false);
m_itemv.Status = 1;
return;
}
else if(ksdd == siteof::ynyx || ksdd == siteof::sxbjxc || ksdd == siteof::sxbjdc || s505_9 == 1)
{
if(cg->tkCnt - m_itemv.TCZT_Tk > 3000)
{
//在前后无干扰条件下停车后，再次挪动车辆
JUDGE_MARK_SUB3(11, "11", false);
}
m_itemv.Status = 1;
return;
}
else
{
if(ksdd == siteof::sccd) //20151230
{
m_itemv.Status = 3;
return;
}
else
{
m_itemv.Status = 1;
return;
}
}
}
//特殊地区处理
if(ksdd == siteof::hnpy)
{
const TChuanGan* his2 = m_car->historyChuanGan(2);
const TChuanGan* his3 = m_car->historyChuanGan(3);
if(cg->move == moveBackward && his1->move == moveBackward && his2->move == moveStop && his3->move == moveStop)
{
//在前后无干扰条件下停车后，再次挪动车辆
JUDGE_MARK_SUB3(11, "11", false);
}
}
//特殊地区处理
if(ksdd == siteof::JXNC)
{
if(cg->tkCnt - m_itemv.tclssjs > m_itemv.Parm_HanZhong_KBTC_SJ)
{
m_itemv.Status = 3;
return;
}
}
//靠边停车确认停车条件（0-拉手刹放空挡或拉手刹动作或开车门或解开安全带 1-拉手刹同时置空档 2-停车就判 3-开车门才判）
if(s430 == "3") //开车门
{
const TSensorInfo& sor2 = m_car->historySensor(2);
const TSensorInfo& sor3 = m_car->historySensor(3);
if(sor.mkg == SYES && sor1.mkg == SYES && sor2.mkg == SNOT && sor3.mkg == SNOT)
{
m_itemv.Status = 3;
return;
}
}
else if(s430 == "1") //拉手刹放空挡
{
//20180625
if(sor.ssc == SYES && sor.dw == 0)
{
m_itemv.Status = 3;
return;
}
}
else
{
const TSensorInfo& sor2 = m_car->historySensor(2);
const TSensorInfo& sor3 = m_car->historySensor(3);
//拉手刹放空挡 或 拉手刹动作 或 开车门 或 解开安全带 进入下一阶段
if((sor.ssc == SYES && sor.dw == SNOT) ||
(sor.ssc == SYES && sor1.ssc == SYES && sor2.ssc == SYES) ||
(sor.mkg == SYES && sor1.mkg == SYES && sor2.mkg == SYES && sor3.mkg == SNOT) ||
(sor.aqd == SNOT && sor1.aqd == SNOT && sor2.aqd == SNOT && sor3.aqd == SYES)) //20180130
{
m_itemv.Status = 3;
return;
}
if(ksdd == siteof::hnay)
{
if(sor.ssc == SYES)
{
m_itemv.Status = 3;
return;
}
}
//20170223
if(ksdd == siteof::gdmm) //广东茂名
{
if(cg->tkCnt - m_itemv.tclssjs > 10 * SECOND)
{
//不按考试员指令驾驶
JUDGE_MARK_SUB3(11, "45", true);
m_exam->TestPro = ItemProFlagEnd;
return;
}
else
{
if(((cg->tkCnt - m_itemv.tclssjs) / 4000) != m_itemv.tclsscnt && m_itemv.tclsscnt < 2)
{
//ToDo:语音提示-->请继续完成考试
m_itemv.tclsscnt++; //inc(m_itemv.tclsscnt);
m_car->createEventSound({itemNo(), sound::sub3_406005});
}
}
}
}
//20170504
if(ksdd == siteof::zhoukou)
{
if(cg->tkCnt - m_itemv.tclssjs > 60 * SECOND)
{
//不按考试员指令驾驶
JUDGE_MARK_SUB3(11, "45", true);
m_exam->TestPro = ItemProFlagEnd;
return;
}
}
}
void Sub3Judge11Kbtc::DoStatus_3()
{
const TChuanGan* cg = m_car->historyChuanGan();
const TSensorInfo& sor = cg->real.sensor;
const TChuanGan* his1 = m_car->historyChuanGan(1);
const TSensorInfo& sor1 = his1->real.sensor;
const std::string& ksdd = TableSysSet->get211();
//特殊地点版本翻译
if(ksdd == siteof::sxbjxc)
{
int wayNo = m_car->wayNo();
if(m_car->wayNo() == 1)
{
if(cg->RTKKM3.BasePointInLaneNo != 2)
{
//不按考试员指令驾驶
JUDGE_MARK_SUB3(11, "45", true);
}
}
else if(wayNo == 2)
{
if(cg->RTKKM3.BasePointInLaneNo != 2)
{
//不按考试员指令驾驶
JUDGE_MARK_SUB3(11, "45", true);
}
}
else if(wayNo == 3)
{
if(cg->RTKKM3.BasePointInLaneNo != 1)
{
//不按考试员指令驾驶
JUDGE_MARK_SUB3(11, "45", true);
}
}
}
if(ksdd == siteof::ynyx)
{
if(sor.yfxd == SYES && sor1.yfxd == SYES)
{
//操作完成后不关闭转向灯
JUDGE_MARK_SUB3(20, "71", true);
}
}
if(m_itemv.dcykkb == 0 || ksdd != siteof::hbwh)
{
if(!m_itemv.HasJudgeFXD)
{
m_itemv.HasJudgeFXD = true;
if(!m_itemv.yfxd)
{
JUDGE_MARK_SUB3(11, "42", false);
}
else
{
if(!m_itemv.yfxd3s)
{
JUDGE_MARK_SUB3(11, "43", false);
}
}
}
}
if(m_car->rtkEnabled())
{
m_itemv.kbtccs = 11;
if(ksdd == siteof::jj && cg->RTKKM3.BaseLaneCount == 0)
{
JUDGE_MARK_SUB3(11, "45", true);
}
if(ksdd == siteof::shanxilinfen && cg->RTKKM3.BaseLaneCount == 0)
{
JUDGE_MARK_SUB3(11, "45", true);
}
if(ksdd == siteof::shenyangkm3 && cg->RTKKM3.BaseLaneCount == 0)
{
JUDGE_MARK_SUB3(11, "45", true);
}
//压路边线
Judge_KBTC_YaXian();
Judge_KBTC_YaXian_Tail(); //A2C6-20250314
}
else
{
//20180531
if(ksdd == siteof::hbtskm3 || ksdd == siteof::lyggy)
m_itemv.kbtccs = 11;
else
m_itemv.kbtccs++; //inc(m_itemv.kbtccs);
}
//信号不好也强制结束
if(m_itemv.kbtccs >= 11)
{
//特殊地点业务翻译
TTestCtl* ctl = m_car->getTTestCtl();
const std::vector<std::string>& s301 = TableSysSet->asArray301();
const std::vector<std::string> s301_1 = s301.size() > 0 ? Tools::split(s301[0], ",") : std::vector<std::string>();
const std::string s301_1_3 = s301_1.size() > 3 && s301_1[3] != "" ? s301_1[3] : "";
if(!ctl->Dw_Cs_Ok1 && s301_1_3 != "0" && ctl->dw_kf_sj == 0 && ksdd == siteof::zjwz)
{
const std::vector<std::vector<std::string>>& s308 = TableSysSet->asArray2_308();
if(!ctl->Dw_Cs_Ok2)
{
const std::vector<std::string> temp = s308.size() > 0 ? s308[0] : std::vector<std::string>(); //getdotstr(1, Sysset[308] + '^', '^');
if(!temp.empty())
{
for(size_t i = 0 ; i < temp.size(); i++)
{
std::string str = temp[i];
if(str == "")
{
break;
}
const std::vector<std::string>& ss = Tools::split(str, ",");
int itemNo = ss.size() > 0 ? std::atoi(ss[0].c_str()) : 0;
std::string serial = ss.size() > 1 ? ss[1] : "";
JUDGE_MARK_SUB3(itemNo, serial.c_str(), false); // JUDGE_MARK_SUB3(StrToInt(GetDotStr(1, str, ',')), GetDotStr(2, str + ',', ','));
}
}
else
{
JUDGE_MARK_SUB3(20, "60", true); //A310 3次
}
}
else
{
const std::vector<std::string> temp = s308.size() > 1 ? s308[1] : std::vector<std::string>();
if(!temp.empty())
{
for(size_t i = 0 ; i < temp.size(); i++)
{
std::string str = temp[i];
if(str == "")
{
break;
}
const std::vector<std::string>& ss = Tools::split(str, ",");
int itemNo = ss.size() > 0 ? std::atoi(ss[0].c_str()) : 0;
std::string serial = ss.size() > 1 ? ss[1] : "";
JUDGE_MARK_SUB3(itemNo, serial.c_str(), false); // JUDGE_MARK_SUB3(StrToInt(GetDotStr(1, str, ',')), GetDotStr(2, str + ',', ','));
}
}
else
{
JUDGE_MARK_SUB3(20, "60", true); //A310
}
}
}
const std::string& s326 = TableSysSet->get326();
//靠边停车后是否进入下车状态评判（0-否 1-是）
if(s326 == "1") //进入下车评判过程
{
m_itemv.Status = 4;
m_itemv.Enter_ljjl = cg->ai_ljjl;
//语音提示-->请下车
m_itemv.jscnt = 1; //20170215
m_itemv.TingCheJiShi = cg->tkCnt; //20170215
m_car->createEventSound({itemNo(), sound::sub3_406004});
}
else
{
m_itemv.Status = 100; // 准备结束项目
//20150702 河南要求 河南洛阳车管所科目三靠边停车修改评判要求：夜考时，靠边停车项目在停车后，拉手刹结束前需要评判是否打开视宽灯或把近光灯调成视宽灯。
if(s326 == "2")
{
TKM3Item* item = m_car->findExamItem(Sub3ItemType13Yjxs);
bool OKFlag = (item && item->Item_Color == itemStateZk);
if(OKFlag == true) //夜间驾驶
{
if(sor1.ygd == SYES || sor1.jgd == SYES || sor1.skd == SNOT)
{
JUDGE_MARK_SUB3(11, "09", true); //夜间在路边临时停车不关闭前照灯或不开启式廓灯
}
}
}
if(s326 == "3") //20150924 河南濮阳
{
m_itemv.Status = 7; //根据安全带松了判断结束 20150922
m_itemv.Enter_Tk = cg->tkCnt; //20151113
}
}
}
}
void Sub3Judge11Kbtc::DoStatus_4()
{
const TChuanGan* cg = m_car->historyChuanGan();
const TSensorInfo& sor = cg->real.sensor;
const TChuanGan* his1 = m_car->historyChuanGan(1);
const TSensorInfo& sor1 = his1->real.sensor;
const std::string& ksdd = TableSysSet->get211();
//贵州特殊功能1
if(Tools::pos(siteof::guizhou, ksdd))
{
const TChuanGan* his2 = m_car->historyChuanGan(2);
const TChuanGan* his3 = m_car->historyChuanGan(3);
const TChuanGan* his4 = m_car->historyChuanGan(4);
if(cg->move == moveForward && his1->move == moveForward && his2->move == moveForward && his3->move == moveStop && his4->move == moveStop)
{
//不按考试员指令驾驶
JUDGE_MARK_SUB3(11, "45", false);
}
}
if((std::abs(cg->tkCnt - m_itemv.TingCheJiShi) / 20000) >= m_itemv.jscnt && ksdd != siteof::SXHZ && ksdd != siteof::hnay)
{
//计次，控制语音的
m_itemv.jscnt++; //inc(m_itemv.jscnt);
//ToDo:语音提示-->靠边停车完成后，请下车
m_car->createEventSound({itemNo(), sound::sub3_406004});
}
if(ksdd == siteof::zjnb)
{
if(cg->tkCnt - m_itemv.TingCheJiShi > 30*SECOND)
{
//不按考试员指令驾驶
JUDGE_MARK_SUB3(11, "45", false);
}
}
if(std::abs(cg->tkCnt - m_itemv.TingCheJiShi) > m_itemv.Parm_TC_KaiCheMen_ShiJian)
{
//不按考试员指令驾驶
JUDGE_MARK_SUB3(11, "45", false);
}
const TSensorInfo& sor2 = m_car->historySensor(2);
const TSensorInfo& sor3 = m_car->historySensor(3);
const TSensorInfo& sor5 = m_car->historySensor(5);
const TSensorInfo& sor6 = m_car->historySensor(6);
const TSensorInfo& sor7 = m_car->historySensor(7);
const TSensorInfo& sor8 = m_car->historySensor(8);
const TSensorInfo& sor9 = m_car->historySensor(9);
const TSensorInfo& sor10 = m_car->historySensor(10);
if(ksdd == siteof::GXWZKM3)
{
if(sor.fdjzs > 0 && sor1.fdjzs > 0 && sor2.fdjzs > 0 && sor5.fdjzs > 0 && sor6.fdjzs == 0 && sor7.fdjzs == 0 && sor10.fdjzs == 0)
{
//因操作不当造成发动机熄火一次
JUDGE_MARK_SUB3(20, "36", false);
}
}
if(ksdd == siteof::hnay)
{
if(sor.fdjzs == 0 && sor1.fdjzs == 0 && sor2.fdjzs == 0 && sor5.fdjzs == 0 &&
sor6.fdjzs == 0 && sor7.fdjzs == 0 && sor8.fdjzs > 0 && sor9.fdjzs > 0 && sor10.fdjzs > 0)
{
if(sor.dw > 0 && sor1.dw > 0)
{
const std::string& s527 = TableSysSet->get527();
if(s527 != "1")
{
//因操作不当造成发动机熄火一次
JUDGE_MARK_SUB3(20, "36", false);
}
m_itemv.chongxindianhuo = true;
m_itemv.chongxindianhuo_tk = cg->tkCnt;
}
if(sor.lhq > 0 && sor1.lhq > 0)
{
//不按考试员指令驾驶
JUDGE_MARK_SUB3(11, "45", false);
}
}
//特殊地点版本
if(m_itemv.chongxindianhuo)
{
if(sor.fdjzs > 500 && sor1.fdjzs > 500 && sor2.fdjzs > 500 && sor5.fdjzs > 500)
{
m_itemv.chongxindianhuo = false;
}
if(cg->tkCnt - m_itemv.chongxindianhuo_tk > 120000)
{
m_itemv.chongxindianhuo_tk = cg->tkCnt;
//不按考试员指令驾驶
JUDGE_MARK_SUB3(11, "45", false);
}
}
else
{
if(sor.dh2 == SYES && sor1.dh2 == SYES && sor2.dh2 == SNOT && sor3.dh2 == SNOT)
{
//不按考试员指令驾驶
JUDGE_MARK_SUB3(11, "45", false);
}
}
}
if((sor.mkg == SYES && sor1.mkg == SYES && sor2.mkg == SYES) || (ksdd == siteof::JXNC && sor.mkg == SYES))
{
//20150304
if(Tools::pos(siteof::guizhou, ksdd) || ksdd == siteof::ynzt)
{
if(!m_itemv.bJc)
{
if(m_itemv.bJc2) //20160229
{
//满足条件
m_itemv.bJc = true;
}
else
{
//需要下车的，在打开车门前不回头观察左后方交通情况
JUDGE_MARK_SUB3(11, "02", false);
m_itemv.bJc = true;
}
}
}
if(ksdd == siteof::changzhoukm3)
{
if(m_itemv.Kf06)
{
//拉紧驻车制动器前放松行车制动踏板
JUDGE_MARK_SUB3(11, "06", false);
m_itemv.Kf06 = false;
}
}
if(sor.ssc == SNOT && !m_itemv.Kf05)
{
m_itemv.Kf05 = true; //20160928
//停车后，未拉紧驻车制动器
JUDGE_MARK_SUB3(11, "05", false);
}
if(sor2.mkg == SYES || (ksdd == siteof::JXNC && sor.mkg == SYES)) //连续3帧数据是开门信号，才算开门 20140825 and (lscg[zj(5)].di_mkg = 1)
{
if(m_itemv.chongxindianhuo)
{
//不按考试员指令驾驶
JUDGE_MARK_SUB3(11, "45", false);
}
TCar* tcar = m_car->getTCar();
//夜考相关的
//2025-02-13 yhy 修改
if(tcar->Night_ID) //if(ksdd == siteof::shanxi && tcar->Night_ID)
{
int c = 0;
if(sor2.skd == SNOT && sor.skd == SNOT)
{
c = 1;
}
if(sor2.jgd == SYES && sor.jgd == SYES)
{
c = 1;
}
if(sor2.ygd == SYES && sor.ygd == SYES)
{
c = 1;
}
if(c == 1)
{
//在路边临时停车不关闭前照灯和不开启示廓灯
JUDGE_MARK_SUB3(13, "07", true);
}
}
//20180403 以开车门就评判
//下车熄火判断时机：0 - 开门；1 - 关门
const std::vector<std::string>& s505 = TableSysSet->asArray505();
int s505_12 = s505.size() > 12 && s505[12] != "" ? std::atoi(s505[12].c_str()) : 0;
if(s505_12 == 0)
{
int c = 0;
if(ksdd == siteof::sxbjxc || ksdd == siteof::sxbjdc)
{
if(sor.fdjzs > 600)
{
c = 1;
}
}
else
{
if(sor.fdjzs > 200)
{
c = 1;
}
}
if(c == 1 && sor.fdjzs < 8000)
{
//下车前不将发动机熄火
JUDGE_MARK_SUB3(11, "08", true);
}
}
if(ksdd == siteof::scyb)
{
if(sor.yfxd + sor.zfxd >= 1 && sor1.yfxd + sor1.zfxd >= 1 && sor2.yfxd + sor2.zfxd >= 1)
{
//不能正确使用灯光、雨刮器等车辆常用操纵件
JUDGE_MARK_SUB3(20, "93", false);
}
}
//20180115
if(ksdd.substr(0, 7) == siteof::guizhou)
{
if(sor.aqd == SYES && sor1.aqd == SYES && sor2.aqd == SYES)
{
//不按规定使用安全带或者戴安全头盔
JUDGE_MARK_SUB3(20, "01", true);
}
}
int s505_10 = s505.size() > 10 && s505[10] != "" ? std::atoi(s505[10].c_str()) : 0;
//下车开门前是否判断安全带
if(s505_10 == 1)
{
if(sor.aqd == SYES && sor1.aqd == SYES && sor2.aqd == SYES)
{
//不按考试员指令驾驶
JUDGE_MARK_SUB3(20, "46", true);
}
}
//开门前不关闭方向灯是否扣分
int s505_11 = s505.size() > 11 && s505[11] != "" ? std::atoi(s505[11].c_str()) : 0;
if(s505_11 == 1)
{
if(sor.yfxd == SYES && sor1.yfxd == SYES)
{
JUDGE_MARK_SUB3(20, "71", false);
}
}
if(ksdd == siteof::zjnb)
{
if(sor.aqd == SYES && sor1.aqd == SYES && sor2.aqd == SYES)
{
//不按考试员指令驾驶
JUDGE_MARK_SUB3(11, "45", true);
}
}
if(ksdd == siteof::nmgcfkm3 || ksdd == siteof::nmgtlkm3 || ksdd == siteof::hnzzkm3)
{
if(sor.dw > 0 && sor1.dw > 0 && sor2.dw > 0 &&
sor.dw < 10 && sor1.dw < 10 && sor2.dw < 10)
{
//不按考试员指令驾驶
JUDGE_MARK_SUB3(11, "45", true);
}
}
//ToDo:头部姿态
m_itemv.Status = 5;
m_itemv.Enter_Tk = cg->tkCnt;
}
//20171212 唐山要求开车门 评判距离
if(ksdd == siteof::hbtskm3 || ksdd == siteof::lyggy)
{
if(m_car->rtkEnabled())
{
Judge_KBTC_YaXian();
Judge_KBTC_YaXian_Tail(); //A2C6-20250314
}
} // 20171211
}
else //20170215
{
if(ksdd == siteof::SXHZ)
{
//靠边停车后，3分钟内每隔30秒提示考试完成请下车考试语音，3分钟后仍然不下车的，以不按考试员指令驾驶评判为不合格。
//20170508
if(std::abs(cg->tkCnt - m_itemv.TingCheJiShi) <= m_itemv.Parm_HanZhong_KBTC_SJ) //3 * 60 * 1000 then
{
if(m_itemv.jscnt < m_itemv.Parm_HanZhong_KBTC_SJ)
{
if((std::abs(cg->tkCnt - m_itemv.TingCheJiShi) / 30*SECOND) >= m_itemv.jscnt)
{
m_itemv.jscnt++; //inc(m_itemv.jscnt);
//ToDo:语音提示-->下车时请注意左后方来车
m_car->createEventSound({itemNo(), sound::sub3_406004});
}
}
}
else
{
JUDGE_MARK_SUB3(11, "45", true);
m_exam->TestPro = ItemProFlagEnd;
return;
}
}
if(ksdd == siteof::HLJDQ || ksdd == siteof::hebeihskm3) //20170616
{
//靠边停车后，3分钟内每隔30秒提示考试完成请下车考试语音，3分钟后仍然不下车的，以不按考试员指令驾驶评判为不合格。
if(std::abs(cg->tkCnt - m_itemv.TingCheJiShi) > m_itemv.Parm_HanZhong_KBTC_SJ) //3 * 60 * 1000 then
{
JUDGE_MARK_SUB3(11, "45", true);
m_exam->TestPro = ItemProFlagEnd;
return;
}
}
}
}
void Sub3Judge11Kbtc::DoStatus_5()
{
const TChuanGan* cg = m_car->historyChuanGan();
const TSensorInfo& sor = cg->real.sensor;
const TChuanGan* his1 = m_car->historyChuanGan(1);
const TSensorInfo& sor1 = his1->real.sensor;
const std::string& ksdd = TableSysSet->get211();
const TSensorInfo& sor2 = m_car->historySensor(2);
const TSensorInfo& sor3 = m_car->historySensor(3);
//如果关门进入下一阶段
if(sor.mkg == SNOT && sor1.mkg == SNOT && sor2.mkg == SNOT && sor3.mkg == SYES)
{
if(ksdd.substr(0,7) == siteof::guizhou)
{
if(sor.fsc == SYES && sor1.fsc == SYES && sor2.fsc == SYES)
{
//不按考试员指令行驶
JUDGE_MARK_SUB3(20, "50", false);
}
}
m_itemv.Status = 6;
//考试结束计时
m_itemv.KaoShiJieShu_JS = cg->tkCnt;
return;
}
//如果到时间15S进入下一阶段
if(cg->tkCnt - m_itemv.Enter_Tk > m_itemv.parm_KaiMen_Status6 * SECOND)
{
m_itemv.Status = 6;
m_itemv.KaoShiJieShu_JS = cg->tkCnt;
return;
}
}
void Sub3Judge11Kbtc::DoStatus_6()
{
const TChuanGan* cg = m_car->historyChuanGan();
const TSensorInfo& sor = cg->real.sensor;
const TChuanGan* his1 = m_car->historyChuanGan(1);
const TSensorInfo& sor1 = his1->real.sensor;
const std::string& ksdd = TableSysSet->get211();
const TSensorInfo& sor2 = m_car->historySensor(2);
const TSensorInfo& sor3 = m_car->historySensor(3);
//SysSet[505]-->13
//下车熄火判断时机：0-开门；1-关门
const std::vector<std::string>& s505 = TableSysSet->asArray505();
int s505_12 = s505.size() > 12 && s505[12] != "" ? std::atoi(s505[12].c_str()) : 0;
if(s505_12 == 1)
{
int c = 0;
if(ksdd == siteof::sxbjxc || ksdd ==siteof::sxbjdc)
{
if(sor.fdjzs > 600)
{
c = 1;
}
}
else
{
if(sor.fdjzs > 200)
{
c = 1;
}
}
if(c == 1 && sor.fdjzs < 8000)
{
//下车前不将发动机熄火
JUDGE_MARK_SUB3(11, "08", true);
}
}
//20190408
if(sor.mkg == SYES && sor1.mkg == SYES && sor2.mkg == SYES && sor3.mkg == SYES && (!IS_C5(m_carType) || ksdd == siteof::shanghaikm3))
{
//下车后不关闭车门
JUDGE_MARK_SUB3(11, "07", true); //20160928
}
TKM3Item* item = m_car->findExamItem(Sub3ItemType13Yjxs); //夜间行驶
bool FindFlag = (item && item->Item_Color == itemStateZk);
if(FindFlag == true) //夜间驾驶
{
if(ksdd == siteof::hbxy) //20160122
{
if(sor.ygd == SYES || sor.jgd == SYES || sor.skd == SNOT || sor.shtd == SNOT)
{
JUDGE_MARK_SUB3(11, "09", false); //夜间在路边临时停车不关闭前照灯或不开启式廓灯
}
}
else
{
if(sor.ygd == SYES || sor.jgd == SYES || sor.skd == SNOT)
{
if(ksdd == siteof::GXWZKM3)
{
//在路边临时停车不关闭前照灯或不开启示廓灯
JUDGE_MARK_SUB3(11, "09", false);
}
else
{
//在路边临时停车不关闭前照灯或不开启示廓灯
JUDGE_MARK_SUB3(11, "09", false);
}
}
}
}
//特殊地点版本处理
if(ksdd == siteof::GXWZKM3)
{
if(cg->tkCnt - m_itemv.KaoShiJieShu_JS > 25 * SECOND)
{
//结束项目处理
m_itemv.Status = 100;
}
}
else if(ksdd == siteof::gxbhkm3)
{
if(cg->tkCnt - m_itemv.KaoShiJieShu_JS > 15 * SECOND)
{
m_itemv.Status = 100;
}
}
else
{
m_itemv.Status = 100;
}
m_car->setPubKaoBianTCFinish_LJJL(cg->ai_ljjl);
}
void Sub3Judge11Kbtc::DoStatus_100()
{
m_exam->TestPro = ItemProFlagEnd;
const std::string& ksdd = TableSysSet->get211();
if(ksdd == siteof::changzhoukm3) //20170315
{
//结束直行路口
m_car->KM3EndItem(Sub3ItemType05Lkzx);
//结束左转弯
m_car->KM3EndItem(Sub3ItemType15Lkzz);
//结束右转弯
m_car->KM3EndItem(Sub3ItemType16Lkyz);
}
//检查是否有未做的项目,除了靠边停车是否都已经完成
bool FindFlag = m_car->itemsNotFinishExcept(Sub3ItemType11Kbtc);
if(FindFlag == true)
{
//ToDo: 语音提示-->请起步，继续完成考试
m_car->createEventSound({itemNo(), sound::sub3_406005});
}
}
void Sub3Judge11Kbtc::Judge_KBTC_YaXian()
{
//3帧车身右上离右侧边线距离
int RightJL0_RF = 0;
int RightJL1_RF = 0;
int RightJL2_RF = 0;
//3帧车身右下离右侧边线距离
int RightJL0_RB = 0;
int RightJL1_RB = 0;
int RightJL2_RB = 0;
//3帧车身右中心点离右侧边线距离
//ZXD_JL0: Integer;
//ZXD_JL1: Integer;
//ZXD_JL2: Integer;
const TRTKResult& RTKKM3_0 = m_car->historyRtkKM3(0);
const TRTKResult& RTKKM3_1 = m_car->historyRtkKM3(1);
const TRTKResult& RTKKM3_2 = m_car->historyRtkKM3(2);
//车身右侧距离计算
//靠边停车以右前轮、右后轮判靠边距离（0-否 1-是）
const std::string& s411 = TableSysSet->get411();
if(s411 != "1")
{
RightJL0_RF = RTKKM3_0.Body_RF_ToBaseLine;
RightJL1_RF = RTKKM3_1.Body_RF_ToBaseLine;
RightJL2_RF = RTKKM3_2.Body_RF_ToBaseLine;
RightJL0_RB = RTKKM3_0.Body_RB_ToBaseLine;
RightJL1_RB = RTKKM3_1.Body_RB_ToBaseLine;
RightJL2_RB = RTKKM3_2.Body_RB_ToBaseLine;
}
else
{
RightJL0_RF = RTKKM3_0.Wheel_RF_ToBaseLine;
RightJL1_RF = RTKKM3_1.Wheel_RF_ToBaseLine;
RightJL2_RF = RTKKM3_2.Wheel_RF_ToBaseLine;
RightJL0_RB = RTKKM3_0.Wheel_RB_ToBaseLine;
RightJL1_RB = RTKKM3_1.Wheel_RB_ToBaseLine;
RightJL2_RB = RTKKM3_2.Wheel_RB_ToBaseLine;
}
//ZXD_JL0 := (RightJL0_RF + RightJL0_RB) div 2;
//ZXD_JL1 := (RightJL1_RF + RightJL1_RB) div 2;
//ZXD_JL2 := (RightJL2_RF + RightJL2_RB) div 2;
int Max_JL0 = std::max(RightJL0_RF, RightJL0_RB);
int Max_JL1 = std::max(RightJL1_RF, RightJL1_RB);
int Max_JL2 = std::max(RightJL2_RF, RightJL2_RB);
if(m_car->rtkEnabled() == false) return;
bool FindFlag = false;
if(RTKKM3_0.TouchLineType == LineType_3 &&
RTKKM3_1.TouchLineType == LineType_3 &&
RTKKM3_2.TouchLineType == LineType_3)
{
FindFlag = true;
}
if(RTKKM3_0.TouchLineTypeCS == LineType_3 &&
RTKKM3_1.TouchLineTypeCS == LineType_3 &&
RTKKM3_2.TouchLineTypeCS == LineType_3)
{
FindFlag = true;
}
//车身出线
bool CheShenChuXian = false;
// 20150415 出线，边缘线为负值
if(FindFlag == true)
{
int JL0 = std::min(RTKKM3_0.Body_RF_ToBaseLine, RTKKM3_0.Body_RB_ToBaseLine);
int JL1 = std::min(RTKKM3_1.Body_RF_ToBaseLine, RTKKM3_1.Body_RB_ToBaseLine);
int JL2 = std::min(RTKKM3_2.Body_RF_ToBaseLine, RTKKM3_2.Body_RB_ToBaseLine);
int s481 = TableSysSet->asInt481();
if(JL0 + s481 < 0 && JL1 + s481 < 0 && JL2 + s481 < 0 && !m_itemv.Kf03)
{
CheShenChuXian = true;
}
}
if(CheShenChuXian == true)
{
m_itemv.Kf03 = true; //20160928
//停车后，车身超过道路右侧边缘线或者人行道边缘
JUDGE_MARK_SUB3(11, "03", false);
}
else
{
const TGpsInfo& gps = m_car->historyGps();
//靠边停车以右前、后轮判靠边距离（0-否 1-是）
满分学习优化
2025-04-07 09:00:36 +08:00
int RtkOffset = m_car->getTCar()->RtkOffset;
int offset = RtkOffset + std::round(gps.jdyz*100) + std::round(gps.wdyz*100);
Max_JL0 -= offset;
Max_JL1 -= offset;
Max_JL2 -= offset;
c++代码添加
2025-03-26 17:01:46 +08:00
//20170724
满分学习优化
2025-04-07 09:00:36 +08:00
int kbtcwc = 50 + m_itemv.kbtcwc;
if(Max_JL0 > kbtcwc && Max_JL1 > kbtcwc && Max_JL2 > kbtcwc)
c++代码添加
2025-03-26 17:01:46 +08:00
{
if(m_itemv.dcykkb == 0) //大车夜考相关的参数
{
//停车后，车身距离道路右侧边缘线或者人行道边缘超出50cm
JUDGE_MARK_SUB3(11, "04", true); //20170724 新增
}
}
else
{
if(Max_JL0 > 30 + m_itemv.kbtcwc && Max_JL1 > 30 + m_itemv.kbtcwc && Max_JL2 > 30 + m_itemv.kbtcwc)
{
if(!m_itemv.Kf10)
{
m_itemv.Kf10 = true; //20160928
if(m_itemv.dcykkb == 0) //20181015
{
//靠边30相关的
JUDGE_MARK_SUB3(11, "10", true);
}
}
}
}
//特殊规则，直接翻译代码即可
if(s411 != "1")
{
std::string txt2 = m_exam->Txt2;
if(Tools::pos(",", txt2))
{
bool ok = Tools::pos("," + RTKKM3_0.MapRoad_Code_No + ",", "," + txt2 + ",");
if(RTKKM3_0.MapRoad_Code_No == "" || (RTKKM3_0.MapRoad_Code_No != "" && ok == false))
{
if(m_itemv.dcykkb == 0) //20181015
{
JUDGE_MARK_SUB3(11, "04", true);
}
}
}
}
}
}
void Sub3Judge11Kbtc::Judge_KBTC_YaXian_Tail()
{
if(!IS_A2C6(m_carType))
{
return;
}
//3帧车身右上离右侧边线距离
int RightJL0_RF = 0;
int RightJL1_RF = 0;
int RightJL2_RF = 0;
//3帧车身右下离右侧边线距离
int RightJL0_RB = 0;
int RightJL1_RB = 0;
int RightJL2_RB = 0;
//3帧车身右中心点离右侧边线距离
//ZXD_JL0: Integer;
//ZXD_JL1: Integer;
//ZXD_JL2: Integer;
const TRTKResult& RTKKM3_Tail_0 = m_car->historyRtkKM3_Tail(0);
const TRTKResult& RTKKM3_Tail_1 = m_car->historyRtkKM3_Tail(1);
const TRTKResult& RTKKM3_Tail_2 = m_car->historyRtkKM3_Tail(2);
//车身右侧距离计算
//靠边停车以右前轮、右后轮判靠边距离（0-否 1-是）
const std::string& s411 = TableSysSet->get411();
if(s411 != "1")
{
RightJL0_RF = RTKKM3_Tail_0.Body_RF_ToBaseLine;
RightJL1_RF = RTKKM3_Tail_1.Body_RF_ToBaseLine;
RightJL2_RF = RTKKM3_Tail_2.Body_RF_ToBaseLine;
RightJL0_RB = RTKKM3_Tail_0.Body_RB_ToBaseLine;
RightJL1_RB = RTKKM3_Tail_1.Body_RB_ToBaseLine;
RightJL2_RB = RTKKM3_Tail_2.Body_RB_ToBaseLine;
}
else
{
RightJL0_RF = RTKKM3_Tail_0.Wheel_RF_ToBaseLine;
RightJL1_RF = RTKKM3_Tail_1.Wheel_RF_ToBaseLine;
RightJL2_RF = RTKKM3_Tail_2.Wheel_RF_ToBaseLine;
RightJL0_RB = RTKKM3_Tail_0.Wheel_RB_ToBaseLine;
RightJL1_RB = RTKKM3_Tail_1.Wheel_RB_ToBaseLine;
RightJL2_RB = RTKKM3_Tail_2.Wheel_RB_ToBaseLine;
}
//ZXD_JL0 := (RightJL0_RF + RightJL0_RB) div 2;
//ZXD_JL1 := (RightJL1_RF + RightJL1_RB) div 2;
//ZXD_JL2 := (RightJL2_RF + RightJL2_RB) div 2;
int Max_JL0 = std::max(RightJL0_RF, RightJL0_RB);
int Max_JL1 = std::max(RightJL1_RF, RightJL1_RB);
int Max_JL2 = std::max(RightJL2_RF, RightJL2_RB);
if(m_car->rtkEnabled2() == false) return;
bool FindFlag = false;
if(RTKKM3_Tail_0.TouchLineType == LineType_3 &&
RTKKM3_Tail_1.TouchLineType == LineType_3 &&
RTKKM3_Tail_2.TouchLineType == LineType_3)
{
FindFlag = true;
}
if(RTKKM3_Tail_0.TouchLineTypeCS == LineType_3 &&
RTKKM3_Tail_1.TouchLineTypeCS == LineType_3 &&
RTKKM3_Tail_2.TouchLineTypeCS == LineType_3)
{
FindFlag = true;
}
//车身出线
bool CheShenChuXian = false;
// 20150415 出线，边缘线为负值
if(FindFlag == true)
{
int JL0 = std::min(RTKKM3_Tail_0.Body_RF_ToBaseLine, RTKKM3_Tail_0.Body_RB_ToBaseLine);
int JL1 = std::min(RTKKM3_Tail_1.Body_RF_ToBaseLine, RTKKM3_Tail_1.Body_RB_ToBaseLine);
int JL2 = std::min(RTKKM3_Tail_2.Body_RF_ToBaseLine, RTKKM3_Tail_2.Body_RB_ToBaseLine);
int s481 = TableSysSet->asInt481();
if(JL0 + s481 < 0 && JL1 + s481 < 0 && JL2 + s481 < 0 && !m_itemv.Kf03)
{
CheShenChuXian = true;
}
}
if(CheShenChuXian == true)
{
m_itemv.Kf03 = true; //20160928
//停车后，车身超过道路右侧边缘线或者人行道边缘
JUDGE_MARK_SUB3(11, "03", false);
}
else
{
const TGpsInfo& gps2 = m_car->historyGps2();
//靠边停车以右前、后轮判靠边距离（0-否 1-是）
满分学习优化
2025-04-07 09:00:36 +08:00
int RtkOffset = m_car->getTCar()->RtkOffset;
int offset = RtkOffset + std::round(gps2.jdyz*100) + std::round(gps2.wdyz*100);
Max_JL0 -= offset;
Max_JL1 -= offset;
Max_JL2 -= offset;
c++代码添加
2025-03-26 17:01:46 +08:00
//20170724
满分学习优化
2025-04-07 09:00:36 +08:00
int kbtcwc = 50 + m_itemv.kbtcwc;
if(Max_JL0 > kbtcwc && Max_JL1 > kbtcwc && Max_JL2 > kbtcwc)
c++代码添加
2025-03-26 17:01:46 +08:00
{
if(m_itemv.dcykkb == 0) //大车夜考相关的参数
{
//停车后，车身距离道路右侧边缘线或者人行道边缘超出50cm
JUDGE_MARK_SUB3(11, "04", true); //20170724 新增
}
}
else
{
if(Max_JL0 > 30 + m_itemv.kbtcwc && Max_JL1 > 30 + m_itemv.kbtcwc && Max_JL2 > 30 + m_itemv.kbtcwc)
{
if(!m_itemv.Kf10)
{
m_itemv.Kf10 = true; //20160928
if(m_itemv.dcykkb == 0) //20181015
{
//靠边30相关的
JUDGE_MARK_SUB3(11, "10", true);
}
}
}
}
//特殊规则，直接翻译代码即可
if(s411 != "1")
{
std::string txt2 = m_exam->Txt2;
if(Tools::pos(",", txt2))
{
bool ok = Tools::pos("," + RTKKM3_Tail_0.MapRoad_Code_No + ",", "," + txt2 + ",");
if(RTKKM3_Tail_0.MapRoad_Code_No == "" || (RTKKM3_Tail_0.MapRoad_Code_No != "" && ok == false))
{
if(m_itemv.dcykkb == 0) //20181015
{
JUDGE_MARK_SUB3(11, "04", true);
}
}
}
}
}
}
void Sub3Judge11Kbtc::NS3JudgeVision_40601()
{
//靠边停车项目中，停车前10s内头部姿态没有大于右后侧角度【25度】
if(!NS3UsingAndData(NS3UsingPose)) return;
int64 nowTime = m_car->GetCurrentTime2();
const TNS3PoseSysset& poseSys = m_nsub3->getPoseSysset();
const TVisionPose* pose0 = m_nsub3->hisPose(0);
if(pose0->zy > poseSys.rightBack)
{
m_itemv.stopPose = nowTime;
}
const TChuanGan* cg = m_car->historyChuanGan();
const TChuanGan* his1 = m_car->historyChuanGan(1);
const TChuanGan* his2 = m_car->historyChuanGan(2);
if(cg->move == moveStop && his1->move == moveStop && his2->move == moveForward)
{
if(nowTime - m_itemv.stopPose > 10*SECOND)
{
m_itemv.stopPose = nowTime;
JUDGE_MARK_NSUB3(11, "01", false);
//NS3video
}
}
}
void Sub3Judge11Kbtc::NS3JudgeVision_40604()
{
//靠边停车项目中，打开车门前10s内头部姿态没有大于左后侧角度【25度】
if(!NS3UsingAndData(NS3UsingPose)) return;
int64 nowTime = m_car->GetCurrentTime2();
const TNS3PoseSysset& poseSys = m_nsub3->getPoseSysset();
const TVisionPose* pose0 = m_nsub3->hisPose(0);
if(pose0->zy < -poseSys.leftBack)
{
m_itemv.doorPose = nowTime;
}
const TSensorInfo& sor = m_car->historySensor();
const TSensorInfo& sor1 = m_car->historySensor(1);
const TSensorInfo& sor2 = m_car->historySensor(2);
if(sor.mkg == SYES && sor1.mkg == SYES && sor2.mkg == SNOT)
{
if(nowTime - m_itemv.doorPose > 10*SECOND)
{
m_itemv.doorPose = nowTime;
JUDGE_MARK_NSUB3(11, "02", false);
//NS3video
}
}
}
Reference in New Issue Copy Permalink