Goalie_with_messi
约 913 字
基于 /home/lkh/robocup/rocos2025/lumina/Medusa/src/Strategy/skill/Goalie.cpp 的代码分析
1. Skill接收TaskT参数的方式
1.1 参数获取
const int vecNumber = task().executor; // 获取机器人号
const CGeoPoint target = task().player.pos; // 获取目标位置来源:在 CGoalie::plan() 方法的开头,通过 task() 函数获取 TaskT 结构中存储的参数。
包含的参数:
task().executor- 执行这个skill的机器人号task().player.pos- 目标位置task().player.angle- 朝向角度task().player.max_acceleration- 最大加速度task().player.flag- 标志位
2. Goalie如何直接访问Messi决策
2.1 反馈球状态给Messi
if(RobotSensor::Instance()->IsKickerOn(vecNumber) > 0) {
MessiDecision::Instance()->setisflyTime(true); // 球在飞
if(_flytimediff) {
MessiDecision::Instance()->setfirstChipDir(self.Dir()); // 记录挑球方向
MessiDecision::Instance()->setfirstChipPos(ball); // 记录挑球位置
}
}交互点:
- Skill通过
MessiDecision::Instance()单例访问Messi决策对象 - 使用
setisflyTime()通知Messi球已被踢出 - 使用
setfirstChipDir()和setfirstChipPos()记录挑球的方向和位置
3. Goalie的三个主要状态及其对应的Skill任务
3.1 CLEAR 状态(清球)
_state = CLEAR;
if((abs((ball - self.Pos()).dir() - self.Dir()) < pi/6
&& abs(self.Dir() - (target - self.RawPos()).dir())<0.15
&& fraredOn>30) || fraredOn>450)
&& ball.x() < -PARAM::Field::PITCH_LENGTH/2 + PARAM::Field::PENALTY_AREA_DEPTH/4*3) {
KickStatus::Instance()->setChipKick(vecNumber, power); // 执行挑球
newTask.player.pos = ball + Utils::Polar2Vector(60, (target - self.Pos()).dir() + pi);
}调用链:
- Skill计算清球条件
- 修改
newTask(即新的TaskT对象) - 通过
setSubTask()分配给下一个skill (SmartGotoPosition)
3.2 STAND 状态(正常防守)
_state = STAND;
CGeoPoint vel_Def_Point = ForGoalieDef_mid(pVision, vecNumber, ball_vel_dir, ball);
CGeoPoint static_Def_Point = ForGoalieDef_mid(pVision, vecNumber, (ball-CGeoPoint(...)).dir(), ball);
// 根据球的位置和速度选择防守点
newTask.player.angle = stand_dir;
newTask.player.pos = real_Pos;
setSubTask(TaskFactoryV2::Instance()->SmartGotoPosition(newTask));特点:
- 根据球的速度方向计算动态防守点
- 根据防御几何关系选择最优防守位置
- 最终通过
setSubTask()分配 SmartGotoPosition 来执行移动
4. 数据流向链
CVisionModule (视觉数据)
↓
Goalie::plan(pVision)
├─ 获取 task().executor ← TaskT结构
├─ 获取 task().player.pos ← Lua脚本或Messi决策
├─ 计算球状态
│ ├─ ball = pVision->ball().Pos()
│ ├─ ball_vel = pVision->ball().Vel().mod()
│ └─ ball_vel_dir = pVision->ball().Vel().dir()
│
├─ 判断状态(CLEAR/STAND/NOTHING)
│
├─ 通过 MessiDecision::Instance() 反馈给Messi
│ ├─ setisflyTime(true)
│ ├─ setfirstChipDir()
│ └─ setfirstChipPos()
│
├─ 计算新的目标位置 (real_Pos, newTask.player.pos)
│
└─ 通过 setSubTask(SmartGotoPosition) 执行移动5. Goalie中的具体数据参考
5.1 从CVisionModule获取的数据
pVision->ourPlayer(vecNumber).Pos()- 机器人位置pVision->ourPlayer(vecNumber).Dir()- 机器人朝向pVision->ball().Pos()- 球位置pVision->ball().Vel()- 球速度pVision->getCycle()- 帧计数
5.2 传感器融合
RobotSensor::Instance()->IsKickerOn(vecNumber)- 踢球装置是否启动Utils::isBallInFace()- 球是否在控制区(红外判断)
5.3 物理模型计算
- 球摩擦系数计算:
FRICTION(从参数管理器加载) - 挑球角度:
alpha = atan2(...) - 剩余速度计算:
inVel = sqrt(pVision->ball().Vel().mod2() - FRICTION * me2ball.mod())
6. Skill与Messi的交互特点
6.1 单向控制(主流)
- Messi → TaskT结构 → Skill接收参数
6.2 反馈机制
- Skill → MessiDecision单例 → 修改Messi的内部状态
6.3 计算独立性
- Goalie在
plan()方法中进行独立的几何和物理计算 - 不完全依赖Messi的高级决策
- 例如:防守点计算 (
ForGoalieDef_mid)、圆弧防守 (抛物线交点计算) 都在Skill层完成
6.4 状态管理
- Goalie维护自己的状态机 (
_state: NOTHING, STAND, CLEAR) - 根据本地传感器状态和视觉信息更新
- 状态间转移基于实时条件判断
7. 关键代码引用
参数来源
- Line 179:
const int vecNumber = task().executor; - Line 180:
const CGeoPoint target = task().player.pos; - Line 182:
const PlayerVisionT& self = pVision->ourPlayer(vecNumber);
Messi交互
- Line 230:
MessiDecision::Instance()->setisflyTime(true); - Line 232:
MessiDecision::Instance()->setfirstChipDir(self.Dir()); - Line 233:
MessiDecision::Instance()->setfirstChipPos(ball);
状态判断
- Line 174:
if (pVision->getCycle() - _lastCycle > PARAM::Vision::FRAME_RATE*0.1) - Line 296:
bool need_clear = Utils::InOurPenaltyArea(ball,90)&&(ball_vel<50*10||fraredOn>1);
任务分配
- Line 335:
setSubTask(TaskFactoryV2::Instance()->SmartGotoPosition(newTask)); - Line 413:
setSubTask(TaskFactoryV2::Instance()->SmartGotoPosition(newTask)); - Line 633:
setSubTask(TaskFactoryV2::Instance()->SmartGotoPosition(newTask));
贡献者
更新日志
2026/2/16 22:23
查看所有更新日志
bc21e-init于