Check this out... here are the two source code pages (digitized from original printouts) for the Kalman filter, dated July 14, 1969!
KALMAN FILTER USER'S PAGE NO. 1
http://www.ibiblio.org/apollo/ScansForConversion/Luminary099...
KALMAN FILTER USER'S PAGE NO. 2
http://www.ibiblio.org/apollo/ScansForConversion/Luminary099...