Fill Missing values of GPS data
second commit

Signed-off-by: dijskl <zhouxiaohua@nlsde.buaa.edu.cn>