Skip to content
体验新版
项目
组织
正在加载...
登录
切换导航
打开侧边栏
Pinoxchio
apollo
提交
f34f2e65
A
apollo
项目概览
Pinoxchio
/
apollo
与 Fork 源项目一致
从无法访问的项目Fork
通知
2
Star
0
Fork
0
代码
文件
提交
分支
Tags
贡献者
分支图
Diff
Issue
0
列表
看板
标记
里程碑
合并请求
0
Wiki
0
Wiki
分析
仓库
DevOps
项目成员
Pages
A
apollo
项目概览
项目概览
详情
发布
仓库
仓库
文件
提交
分支
标签
贡献者
分支图
比较
Issue
0
Issue
0
列表
看板
标记
里程碑
合并请求
0
合并请求
0
Pages
分析
分析
仓库分析
DevOps
Wiki
0
Wiki
成员
成员
收起侧边栏
关闭侧边栏
动态
分支图
创建新Issue
提交
Issue看板
体验新版 GitCode,发现更多精彩内容 >>
提交
f34f2e65
编写于
5月 08, 2019
作者:
Y
Yajia Zhang
提交者:
Qi Luo
5月 09, 2019
浏览文件
操作
浏览文件
下载
电子邮件补丁
差异文件
planning: typo fix
上级
6e3bd06d
变更
2
隐藏空白更改
内联
并排
Showing
2 changed file
with
1 addition
and
70 deletion
+1
-70
modules/planning/math/piecewise_jerk/piecewise_jerk_problem.cc
...es/planning/math/piecewise_jerk/piecewise_jerk_problem.cc
+0
-69
modules/planning/math/piecewise_jerk/piecewise_jerk_problem.h
...les/planning/math/piecewise_jerk/piecewise_jerk_problem.h
+1
-1
未找到文件。
modules/planning/math/piecewise_jerk/piecewise_jerk_problem.cc
浏览文件 @
f34f2e65
...
...
@@ -199,62 +199,6 @@ bool PiecewiseJerkProblem::Optimize(const int max_iter) {
return
true
;
}
//void PiecewiseJerkProblem::CalculateKernel(std::vector<c_float>* P_data,
// std::vector<c_int>* P_indices,
// std::vector<c_int>* P_indptr) {
// const size_t n = num_of_knots_;
// const size_t num_of_variables = 3 * n;
// std::vector<std::vector<std::pair<c_int, c_float>>> columns;
// columns.resize(num_of_variables);
// size_t value_index = 0;
//
// // x(i)^2 * (w_x + w_ref)
// for (size_t i = 0; i < n; ++i) {
// columns[i].emplace_back(i, weight_x_ + weight_x_reference_);
// ++value_index;
// }
//
// // x(i)'^2 * w_dx
// for (size_t i = 0; i < n; ++i) {
// columns[n + i].emplace_back(n + i, weight_dx_);
// ++value_index;
// }
//
// auto delta_s_square = delta_s_ * delta_s_;
// // x(i)''^2 * (w_ddx + 2 * w_dddx / delta_s^2)
// columns[2 * n].emplace_back(
// 2 * n, weight_ddx_ + weight_dddx_ / delta_s_square);
// ++value_index;
// for (size_t i = 1; i + 1 < n; ++i) {
// columns[2 * n + i].emplace_back(
// 2 * n + i, weight_ddx_ + 2.0 * weight_dddx_ / delta_s_square);
// ++value_index;
// }
// columns[3 * n - 1].emplace_back(
// 3 * n - 1, weight_ddx_ + weight_dddx_ / delta_s_square);
// ++value_index;
//
// // -2 * w_dddx / delta_s^2 * x(i)'' * x(i + 1)''
// for (size_t i = 0; i + 1 < n; ++i) {
// columns[2 * n + i].emplace_back(
// 2 * n + i + 1, -2.0 * weight_dddx_ / delta_s_square);
// ++value_index;
// }
//
// CHECK_EQ(value_index, num_of_variables + n - 1);
//
// size_t ind_p = 0;
// for (size_t i = 0; i < num_of_variables; ++i) {
// P_indptr->push_back(ind_p);
// for (const auto& row_data_pair : columns[i]) {
// P_indices->push_back(row_data_pair.first);
// P_data->push_back(row_data_pair.second * 2.0);
// ++ind_p;
// }
// }
// P_indptr->push_back(ind_p);
//}
void
PiecewiseJerkProblem
::
CalculateAffineConstraint
(
std
::
vector
<
c_float
>*
A_data
,
std
::
vector
<
c_int
>*
A_indices
,
std
::
vector
<
c_int
>*
A_indptr
,
std
::
vector
<
c_float
>*
lower_bounds
,
...
...
@@ -353,18 +297,5 @@ void PiecewiseJerkProblem::CalculateAffineConstraint(
A_indptr
->
push_back
(
ind_p
);
}
//void PiecewiseJerkProblem::CalculateOffset(std::vector<c_float>* q) {
// CHECK_NOTNULL(q);
// const size_t N = num_of_knots_;
// q->resize(3 * N, 0.0);
//
// for (size_t i = 0; i < N; ++i) {
// q->at(i) += -2.0 * weight_x_reference_ * x_ref_[i];
// }
//// q->at(N - 1) += -2.0 * weight_x_ * x_end_[0];
//// q->at(N * 2 - 1) += -2.0 * weight_dx_ * x_end_[1];
//// q->at(N * 3 - 1) += -2.0 * weight_ddx_ * x_end_[2];
//}
}
// namespace planning
}
// namespace apollo
modules/planning/math/piecewise_jerk/piecewise_jerk_problem.h
浏览文件 @
f34f2e65
...
...
@@ -64,7 +64,7 @@ class PiecewiseJerkProblem {
const
double
dx_upper_bound
);
void
set_ddx_bounds
(
std
::
vector
<
std
::
pair
<
double
,
double
>>
d
2
x_bounds
);
void
set_ddx_bounds
(
std
::
vector
<
std
::
pair
<
double
,
double
>>
d
d
x_bounds
);
void
set_ddx_bounds
(
const
double
ddx_lower_bound
,
const
double
ddx_upper_bound
);
...
...
编辑
预览
Markdown
is supported
0%
请重试
或
添加新附件
.
添加附件
取消
You are about to add
0
people
to the discussion. Proceed with caution.
先完成此消息的编辑!
取消
想要评论请
注册
或
登录