Merge pull request #5 from tdenewiler/fix-twist-init
Fixing initialization of linear velocity output commands in simple ca…master
commit
8a7d14049f
|
@ -81,7 +81,7 @@ class SimpleCarModel : public BaseRobotSE2
|
|||
{
|
||||
assert(u.size() == getInputDimension());
|
||||
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.x = twist.angular.y = 0;
|
||||
|
|
|
@ -72,7 +72,7 @@ class UnicycleModel : public BaseRobotSE2
|
|||
{
|
||||
assert(u.size() == getInputDimension());
|
||||
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.x = twist.angular.y = 0;
|
||||
|
|
Loading…
Reference in New Issue