I have completed the first prototype.
It is using gpstk for handling the subframes, and position calculation.
Now moving on to collecting more data sets.
Looks like the initial error is within 10-60 meters.
Ill try to clean up the prototype and post the binary.