fix(driver_gps_hcp2):add speed decode and output by shm

src/driver/driver_gps_hcp2/hcp2.cpp

@@ -507,7 +507,9 @@ void hcp2::SerialGPSDecodeSen(QString strsen)
    strx = strlistrmc.at(17);
    vu = strx.toDouble();
 
-   fVel = sqrt(ve*ve + vn* vn);
+//   fVel = sqrt(ve*ve + vn*vn + vu*vu);
+   strx = strlistrmc.at(18);
+   fVel = strx.toDouble();
 
    if((mTime.elapsed()-mOldTime) >= 100)
    {
@@ -592,6 +594,7 @@ void hcp2::SerialGPSDecodeSen(QString strsen)
    gpsimu.set_vd(vu);
    gpsimu.set_ve(ve);
    gpsimu.set_vn(vn);
+   gpsimu.set_speed(fVel);
    gpsimu.set_lat(fLat);
    gpsimu.set_lon(fLon);
    gpsimu.set_heading(fheading);
@@ -638,6 +641,7 @@ void hcp2::SerialGPSDecodeSen(QString strsen)
    mfVe = ve;
    mfVn = vn;
    mfVu = vu;
+   mVel = fVel;
    mheading = fheading;
    mfPitch = fPitch;
    mfRoll = fRoll;