Go to the source code of this file.
Functions | |
| length of | truck (in meters) from back axle to front axle truckLength=0.3048 |
| truckTheta (1)=0 | |
| steeringAngle (1)=0 | |
| x (1)=0 | |
| y (1)=0 | |
| truckThetaD (1) | |
| truckThetaD (i) | |
| if | abs (truckVelocity(i)) > 0.000001 steeringAngle(i) |
| else | steeringAngle (i) |
| end | truckTheta (i) |
| x (i) | |
| y (i) | |
Variables | |
| function [x, y, truckTheta, truckThetaD, steeringAngle, truckVelocity] | |
| ticksPerMeter = 3951.0979 | |
| metersPerTick = 1 / ticksPerMeter | |
| convert ticks to meters | fr = fr * metersPerTick |
| fl = fl * metersPerTick | |
| br = br * metersPerTick | |
| bl = bl * metersPerTick | |
| len = length(fr) | |
| timeD = [0 | |
| time(2:len)-time( | frD ) = [ 0 |
| fr(2:len)-fr( | flD ) = [ 0 |
| fl(2:len)-fl( | brD ) = [ 0 |
| br(2:len)-br( | blD ) = [ 0 |
| bl(2:len)-bl( | truckThetaD )(1)=0 |
| filterAlpha = 1 | |
| for | i |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
Definition at line 18 of file encEstimator.m. Referenced by main(). |
|
|
Definition at line 26 of file encEstimator.m. |
|
|
Definition at line 17 of file encEstimator.m. Referenced by main(). |
|
|
Definition at line 25 of file encEstimator.m. |
|
|
Definition at line 36 of file encEstimator.m. |
|
|
Definition at line 16 of file encEstimator.m. Referenced by main(). |
|
|
Definition at line 24 of file encEstimator.m. |
|
|
Definition at line 15 of file encEstimator.m. Referenced by main(). |
|
|
Definition at line 23 of file encEstimator.m. |
|
|
Initial value: encEstimator(time,fr,fl,br,bl) % function [x, y, truckTheta, truckThetaD, steeringAngle] = encEstimator(fr,fl,br,bl) % distance from center of one truck wheel to center of other truck wheel axleLength = 0.37465 Definition at line 1 of file encEstimator.m. |
|
|
|
Definition at line 20 of file encEstimator.m. Referenced by Accept_server(), mcu_read(), RTAI_PROTO(), and GPS::writeLine(). |
|
|
Definition at line 12 of file encEstimator.m. |
|
|
Definition at line 11 of file encEstimator.m. |
|
|
Definition at line 22 of file encEstimator.m. |
|
|
Definition at line 28 of file encEstimator.m. |
1.4.4