Fixed launch file
added to launch file
Added Kalman filter testing