Revision 1812
Fixes wheel speed noise, prettier visualization with scaled arrows, and always displays plots
computeTrajectories.m | ||
---|---|---|
2 | 2 |
% This function expects to NOT have the quees be at index 1 |
3 | 3 |
function [V,W] = computeTrajectories(X,Y,Theta,XD,YD,ThetaD) |
4 | 4 |
|
5 |
Kp = 5;
|
|
5 |
Kp = 7;
|
|
6 | 6 |
|
7 | 7 |
% how far away are we |
8 | 8 |
dists = sqrt((X-XD).^2 + (Y-YD) .^ 2); |
Also available in: Unified diff