本文整理汇总了C++中Pose::queryX方法的典型用法代码示例。如果您正苦于以下问题：C++ Pose::queryX方法的具体用法？C++ Pose::queryX怎么用？C++ Pose::queryX使用的例子？那么, 这里精选的方法代码示例或许可以为您提供帮助。您也可以进一步了解该方法所在类Pose的用法示例。
在下文中一共展示了Pose::queryX方法的1个代码示例，这些例子默认根据受欢迎程度排序。您可以为喜欢或者感觉有用的代码点赞，您的评价将有助于系统推荐出更棒的C++代码示例。
示例1: getTrajectoryPath
QPainterPath getTrajectoryPath(FType func, Pose s, int vl_s, int vr_s, Pose e, int vl_e, int vr_e,
double timespanMs, double timeLCMs) {
// using some code from simulate() in dialog.cpp
QPainterPath p;
p.moveTo(s.queryX(), s.queryY());
double final_vel = max(fabs(vl_e), fabs(vr_e));
ControllerWrapper dc(func, vl_s, vr_s, 0); // not using any delay for trajectory drawing.
Pose curPose = s;
for (int i = 0; i*timeLCMs < timespanMs; i++) {
int vl, vr;
dc.genControls(curPose, e, vl, vr, final_vel);
// patch up code;
// insertArcInPath(p, curPose.theta(), vl, vr, timeLCMs*0.001);
curPose.update(vl, vr, timeLCMs*0.001);
p.lineTo(curPose.queryX(), curPose.queryY());
}
return p;
}