Initialize the filter for first use.

Signed-off-by: cctsao1008 <chiacheng.tsao@gmail.com>
The purpose is to implement the Kalman Filter and using it to estimate a proper location.
Due to the measured data from GPS (location and latitude) may include noise, So using Kalman Filtering to estimate the proper location.

Signed-off-by: cctsao1008 <chiacheng.tsao@gmail.com>