Now plots the estimated speed vector
Ongoing works..