goAndTurnKick_with_messi
约 1009 字
Skill-Messi协作流程(基于goAndTurnKick代码)
1️⃣ 状态获取与同步
从Messi获取决策信息 [L456-468]
if(ball_in_face &&!rorate){
getBallMode = HOLDING;
state = "Holding";
}else{
if(MessiDecision::Instance()->isFlytime()){ // ← 查询Messi的挑球决策
getBallMode = CHIP;
state = "Chip";
}
else{
getBallMode = NEED_GET;
state = "NeedGet";
}
}
if(ball_in_face && lastGetBallMode == HOLDING) getBallMode = HOLDING;
MessiDecision::Instance()->setLeaderState(state); // ← 反馈本地状态给Messi流程说明:
- 检查球是否在机器人正前方
ball_in_face - 若有球,根据Messi的
isFlytime()判断是否处于飞球阶段 - 将当前动作状态(Holding/Chip/NeedGet)同步回Messi
2️⃣ 接应队员位置同步 [L462-465]
const PlayerVisionT& Receiver = pVision->ourPlayer(MessiDecision::Instance()->receiverNum());
double receiver2targettime = predictedTime(Receiver,target);获取接应信息:
receiverNum()- Messi计算出的最优接应队员ID- 结合
receiver2targettime预测该接应队员到达目标点的时间
传球决策使用 [L1034-1043]
double predictTime = predictedTime(pVision->ourPlayer(MessiDecision::Instance()->receiverNum()),
MessiDecision::Instance()->receiverPos());
if(fabs(Utils::Normalize(me.Dir() - me2target.dir())) > 90*PARAM::Math::PI/180.0){
targetDir = me2ball.dir();
// ... 持球状态
}else{
// 当角度满足条件时,检查接应队员就位情况
if((abs(Utils::Normalize((target - me.Pos()).dir() - me.Dir())) < 10 * PARAM::Math::PI/180 ||
(me.Dir() > leftdir && me.Dir() < rightdir && Utils::InTheirPenaltyArea(target,0)))){
if(pVision->getCycle() - _mylastCycle > 2){
if(Utils::InTheirPenaltyArea(target,0)){
KickStatus::Instance()->setKick(runner,power);
DribbleStatus::Instance()->setDribbleOff(runner);
}else if((abs(Utils::Normalize((target - me.Pos()).dir() - me.Dir())) < 10 * d/180)){
if(MessiDecision::Instance()->needChip()){ // ← 查询是否需要挑球传球
KickStatus::Instance()->setChipKick(runner,power);
} else{
KickStatus::Instance()->setKick(runner,power);
}
DribbleStatus::Instance()->setDribbleOff(runner);
}
}
}
}3️⃣ 禁用全局更新机制 [L679-696]
if(ball_in_face){
targetPos = ballPos + Utils::Polar2Vector(-50,me2ball.dir());
chase_task.player.vel = Utils::Polar2Vector(10*70,me2ball.dir());
if(noUpdatecnt<75*2){
thisnoUpdate=true;
MessiDecision::Instance()->setnoUpdate(true); // ← 短期禁用Messi全局重算
}
// DribbleStatus::Instance()->setDribbleCommand(runner,3);
}else{
if(fabs(Utils::Normalize(me2ball.dir() - ball2target.dir())) < 30/180.0*PARAM::Math::PI &&
fabs(Utils::Normalize(ball2Projection4target.dir() - target2ball.dir())) < 0.1 &&
me2ball.mod() < 50*10 && fabs(me.RawRotVel())<1.5){
targetPos = ballPos + Utils::Polar2Vector(50,target2ball.dir());
// DribbleStatus::Instance()->setDribbleCommand(runner,3);
if(noUpdatecnt<75*2)
MessiDecision::Instance()->setnoUpdate(true); // ← 禁用更新
chase_task.player.vel = Utils::Polar2Vector(70*10,(targetPos - me.Pos()).dir());
}
}更新控制机制:
if(thisnoUpdate){
noUpdatecnt++;
if(noUpdatecnt>=75*2)MessiDecision::Instance()->setnoUpdate(false); // ← 恢复更新
if(noUpdatecnt>=75*2+2){
thisnoUpdate = false;
noUpdatecnt = 0;
}
}4️⃣ 球运动状态判断 [L450-475]
if(isBallMoving) touchCnt = touchCnt > maxTime ? maxTime : touchCnt + 1;
else touchCnt = 0;
if(touchCnt > 1) cantouch = true;
else cantouch = false;多模式获球逻辑 [L479-618]
else if(getBallMode == NEED_GET){
if(cantouch /*&& !needChase*/ && !ball_in_face){
// 模式A: 直接触球接应
rorate = false;
taskFlag |= PlayerStatus::NOT_AVOID_OUR_VEHICLE | PlayerStatus::MIN_DSS;
double inVel;
if(pow(ballVelMod,2) > FRICTION * me2ball.mod())
inVel = sqrt(pow(ballVelMod,2) - FRICTION * me2ball.mod()); // 球速衰减计算
else
inVel = ballVelMod;
// 矢量合成计算最优接球角度
double beta = Utils::Normalize(ballVelDir + PARAM::Math::PI - me2target.dir());
double alpha = atan2(power * sin(beta) / 0.42 + 1e-5,
inVel + power * cos(beta) / 0.42 + 1e-5);
// 触球点计算
CGeoPoint touch_pos = ballline.projection(me.Pos() + Utils::Polar2Vector(PARAM::Vehicle::V2::PLAYER_CENTER_TO_BALL_CENTER+touch_buffer,
me2target.dir())) +
Utils::Polar2Vector(PARAM::Vehicle::V2::PLAYER_CENTER_TO_BALL_CENTER+touch_buffer,
me2target.dir() + PARAM::Math::PI);
// 接球/传球判断 [L541-545]
if(abs(Utils::Normalize(me2target.dir() + beta - alpha - (ball.Vel().dir() + PARAM::Math::PI)))
> PARAM::Math::PI*70/180.0){
_state = RECEIVE; // 侧向接球
// ... 侧向接球处理逻辑
}else{
_state = TOUCH; // 直接射门/传球
if((Utils::InTheirPenaltyArea(target,0)
&& fabs(Utils::Normalize(me.Dir()-me2target.dir())) < PARAM::Math::PI/6)
|| ((Receiver.Pos().dist(target) < 110*10 && receiver2targettime < 1.8)
&& fabs(me.Dir() - (me2target.dir() + beta - alpha)) < 10.0 * PARAM::Math::PI / 180)){
DribbleStatus::Instance()->setDribbleOff(runner);
if(MessiDecision::Instance()->needChip()){ // ← 检查Messi芯片决策
KickStatus::Instance()->setChipKick(runner,power);
} else {
KickStatus::Instance()->setKick(runner,power);
}
touch_flag=true;
}
}
} else {
// 模式B: 追球模式 [L619+]
_state = CHASE;
// ... 追球逻辑
}
}5️⃣ 协作决策数据流
┌─────────────────────────────────────────────────
│ Messi Decision System
│ ┌───────────────────────────────────────────────
│ │ • Leader判断: leaderNum()
│ │ • Receiver计算: receiverNum(), receiverPos()
│ │ • 飞球决策: isFlytime()
│ │ • 芯片判断: needChip()
│ │ • 全局更新: _noupdate
│ └───────────────────────────────────────────────
└───────────────────┬─────────────────────────────
│ ← setLeaderState(state)
│ ← setnoUpdate(bool)
↓
┌─────────────────────────────────────────────────
│ goAndTurnKick::plan()
│
│ [L456-468] getBallMode判断
│ ├─ HOLDING (球在手)
│ ├─ CHIP (通过Messi->isFlytime())
│ └─ NEED_GET (需要接球)
│
│ [L479-618] 接应策略
│ ├─ 直接触球 (依据Receiver就位情况)
│ ├─ 侧向接球 (多路线选择)
│ └─ 追球排位 (预留给Receiver)
│
│ [L679-696] 禁用更新控制
│ └─ setnoUpdate(true/false) → Messi暂停重算
└─────────────────────────────────────────────────6️⃣ 关键反馈接口总结
| 接口调用 | 行号 | 作用 |
|---|---|---|
isFlytime() | 457 | 获取是否为挑球机会 |
needChip() | 1036/558 | 查询是否需要挑球传球 |
receiverNum() | 462 | 获取接应队员ID |
receiverPos() | 1032 | 获取接应点位 |
setLeaderState() | 468 | 反馈Leader当前动作 |
setnoUpdate() | 680/755 | 控制Messi暂停/恢复更新 |
核心特点:goAndTurnKick通过"查询→执行→反馈"的三层闭环,在保持局部精细化控制的同时,与Messi全局决策系统实现动态同步。
贡献者
更新日志
2026/2/16 22:23
查看所有更新日志
bc21e-init于