I would be interested to copy your solution (from the FEX? hint, hint). I expect a standard Kalman implementation would require quite some editing to implement multiple sources and sorting them.
You could also approach this as a 4D curve fitting problem (lat,long,alt,time) and let Matlab do the heavy lifting instead of implementing a Kalman filter.
