Add color to eigenvalue plots.

In controller and estimator eigenvalue plots, color eigenvalues by
forward speed of the system.

Signed-off-by: Dale Lukas Peterson <hazelnusse@gmail.com>