gsp: Compilation and bug fix loopback of state estimate.

I made some silly mistakes in the previous mistake. However most importantly
there was a mistake that only copy 3 bytes when it was trying to copy 3 floats.