12345qiupeng
/
mpc_local_planner
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

Merge pull request #5 from tdenewiler/fix-twist-init 

Fixing initialization of linear velocity output commands in simple ca…
master
Christoph Rösmann 2020-03-05 09:23:46 +01:00 committed by GitHub
parent f45dfee6df a9a4d51b6b
commit 8a7d14049f
No known key found for this signature in database
GPG Key ID: 4AEE18F83AFDEB23
2 changed files with 2 additions and 2 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

2
mpc_local_planner/include/mpc_local_planner/systems/simple_car.h
View File

@ -81,7 +81,7 @@ class SimpleCarModel : public BaseRobotSE2
{ {
assert(u.size() == getInputDimension()); assert(u.size() == getInputDimension());
twist.linear.x = u[0]; twist.linear.x = u[0];
twist.linear.y = twist.linear.y = 0; twist.linear.y = twist.linear.z = 0;
twist.angular.z = u[1]; // warning, this is the angle and not the angular vel twist.angular.z = u[1]; // warning, this is the angle and not the angular vel
twist.angular.x = twist.angular.y = 0; twist.angular.x = twist.angular.y = 0;

2
mpc_local_planner/include/mpc_local_planner/systems/unicycle_robot.h
View File

@ -72,7 +72,7 @@ class UnicycleModel : public BaseRobotSE2
{ {
assert(u.size() == getInputDimension()); assert(u.size() == getInputDimension());
twist.linear.x = u[0]; twist.linear.x = u[0];
twist.linear.y = twist.linear.y = 0; twist.linear.y = twist.linear.z = 0;
twist.angular.z = u[1]; twist.angular.z = u[1];
twist.angular.x = twist.angular.y = 0; twist.angular.x = twist.angular.y = 0;