Speed Fusion

Speed Fusion

Overview

Speed Fusion combines data from multiple sensors to produce a single, accurate speed measurement that is more reliable than any individual source. It draws on GPS speed, drive speed (from the ECU or CAN bus), wheel speed sensors, and IMU data (accelerometer and gyroscope) to deliver a smooth, low-latency fused speed output.

Speed Fusion continuously monitors for wheel slip and automatically reduces the influence of any sensor that appears unreliable, such as a spinning driven wheel under hard acceleration.

Key Features

  • Combines GPS, drive speed, wheel speeds, and IMU data into a single reliable output
  • Automatically detects and discounts wheel slip
  • Compensates for sensor drift over time
  • Works with partial sensor sets — unused inputs can be left unconfigured

Configuration

Enable / Disable

SettingDescription
EnabledTurns Speed Fusion on or off. When disabled, no fused speed is produced.

Sensor Inputs

Assign each input to the channel that provides that sensor’s data. Leave a channel unassigned if that sensor is not available — Speed Fusion will simply use whichever sources are connected.

InputDescriptionUnits
Drive SpeedSpeed from the vehicle ECU or CAN buskph
GPS SpeedSpeed from the GPS receiverkph
Front-Left Wheel SpeedIndividual wheel speed sensorkph
Front-Right Wheel SpeedIndividual wheel speed sensorkph
Rear-Left Wheel SpeedIndividual wheel speed sensorkph
Rear-Right Wheel SpeedIndividual wheel speed sensorkph
Longitudinal AccelerationForward/backward acceleration from IMUm/s²
Vertical AccelerationUp/down acceleration from IMUm/s²
Pitch RateNose-up/nose-down rotation rate from IMU°/s

Wheel Drive Configuration

Indicate which wheels are driven (powered) by the motor. Speed Fusion prefers non-driven wheels for speed estimation because driven wheels are more likely to slip under acceleration.

SettingDescription
Front-Left DrivenEnable if this wheel is driven
Front-Right DrivenEnable if this wheel is driven
Rear-Left DrivenEnable if this wheel is driven
Rear-Right DrivenEnable if this wheel is driven

Examples:

  • Front-wheel drive: enable Front-Left and Front-Right
  • Rear-wheel drive: enable Rear-Left and Rear-Right
  • All-wheel drive: enable all four

When all wheels are driven, Speed Fusion still uses wheel speeds but treats them as less reliable and relies more heavily on GPS and drive speed.


Tuning Parameters

These settings control how much Speed Fusion trusts each sensor source, and how aggressively it detects wheel slip. The defaults are appropriate for most vehicles — only adjust these if you observe specific problems.

Sensor Trust

Lower values mean more trust in that source; higher values mean less trust. Think of these as a confidence level for each sensor’s accuracy.

ParameterDefaultDescription
GPS Speed Trust1.0 kphHow much variation is expected in the GPS speed reading
Drive Speed Trust0.5 kphHow much variation is expected in the drive speed from the ECU/CAN
Wheel Speed Trust0.3 kphHow much variation is expected in wheel speed readings
Speed Responsiveness1.0 kphHow freely the fused speed estimate can change between updates — increase if output lags, decrease if output is jittery
Vertical Accel Trust3.0 m/s²How closely vertical acceleration tracks expected gravity — higher values allow more pitch angle variation

Slip Detection

ParameterDefaultDescription
Slip Gate10.0 kphMaximum allowable difference between a sensor reading and the current speed estimate before that reading is rejected. Increase if valid readings are being discarded during hard acceleration; decrease if bad readings are affecting the output.
Acceleration Slip Threshold3.0 m/s²How large an acceleration mismatch between wheel sensors and the IMU must be before wheel slip is declared. Lower values detect slip earlier; higher values only flag severe slip.

Tuning Guide

Starting Point

The defaults work well for most vehicles. Before adjusting anything, verify that all configured channels are receiving valid data and that sensor units are correct (speeds in kph, acceleration in m/s²).

Common Adjustments

SymptomAdjustment
Fused speed lags behind actual speedIncrease Speed Responsiveness
Fused speed is jittery or noisyDecrease Speed Responsiveness, or increase the trust value for the noisiest sensor
Wheel slip not being detectedDecrease Acceleration Slip Threshold
Valid readings incorrectly rejected during accelerationIncrease Slip Gate
GPS signal is unreliable (tunnels, urban areas)Increase GPS Speed Trust to reduce GPS influence
Drive speed source has noticeable latencyIncrease Drive Speed Trust to reduce its influence

Driving Style Adjustments

  • Street or steady-state driving — use lower (default) responsiveness values for a smooth output
  • Motorsport / high-dynamics driving — increase Speed Responsiveness to allow the estimate to change more quickly
  • Off-road or rough terrain — increase sensor trust values to tolerate higher sensor noise

Troubleshooting

ProblemLikely CauseSolution
No fused speed outputSpeed Fusion is disabled, or no sensor channels are configuredEnable Speed Fusion and verify at least one speed input is assigned
Fused speed lags actual speedSpeed Responsiveness is too lowIncrease Speed Responsiveness
Fused speed is jitterySensor trust values are too low (over-trusting noisy sensors)Increase trust values for noisy sources
Wheel slip not detectedAcceleration Slip Threshold is too highDecrease Acceleration Slip Threshold
Valid measurements rejectedSlip Gate is too tightIncrease Slip Gate
Pitch angle appears incorrectIMU sensor orientation or calibration issueVerify accelerometer and gyroscope channel assignments and sensor mounting