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