The invention discloses a digestive endoscopic esophageal
trajectory optimization method based on Kalman filtering, and belongs to the technical field of digestive endoscopic surgical navigation, and the method comprises the following steps: S1, based on an esophageal model of preoperative CT three-dimensional reconstruction, extracting a geometric center
point sequence of an esophageal cavity, generating an esophageal center line, and extracting a geometric center
point sequence of the esophageal cavity; the method comprises the following steps of S1, acquiring six-degree-of-freedom
pose data of the front end of an
endoscope in real time through an electromagnetic
positioning system, and generating an original motion track, and S3, performing
rigid body registration on the original motion track and an
esophagus center line by utilizing an
iterative closest point (ICP)
algorithm, so as to realize coordinate
system coarse alignment. The real-
time data of an electromagnetic
positioning system and a three-dimensional model reconstructed by CT are combined, the navigation robustness is improved, the
pose is adaptively corrected through Kalman filtering, the influence of environmental interference is reduced, the space relation between the
endoscope and surrounding organs is visually displayed through an optimized track, and accurate operation of a doctor is assisted.