用于SLAM的，如何比较两断轨迹，以及如何将这两段轨迹用pangolin在界面中绘制出来

1305031526.67147303 0 0 0 0 0 1 0 1305031526.70754695 0.00288319499999999986 -0.00466209999999999975 -0.00225430399999999994 0.0106974147769499078 0.00218949395434721002 0.999875286151759579 0.0114098017620960397 1305031526.77148104 0.0139789660000000007 -0.0130823169999999996 -0.0108695960000000005 0.0325266728104138744 0.00326054208123759126 0.998528028878688856 0.0432800180783373817 1305031526.80745506 -0.00160120899999999992 -0.0114045459999999998 -0.0268415289999999994 0.0520713221589042333 0.00091570100279441259 0.995935085039260204 0.0734918042242723585 1305031526.87144589 -0.00442845599999999989 -0.00133393800000000001 -0.042973492000000002 0.0708477644042826288 -0.00660150894449177718 0.990774146669160416 0.115341253030162946 1305031526.90748405 -0.00648750300000000037 -0.00346477100000000017 -0.0581952629999999971 0.0812489619239377819 -0.0103815121180553093 0.987398218228383806 0.13540896953982845 1305031526.93961811 -0.0143312160000000008 -0.0136600920000000004 -0.078787915 0.0919272047025398997 -0.0151385086097317149 0.98462591565764801 0.147756626951174169 1305031526.97150993 -0.0186255030000000016 -0.0154946430000000007 -0.0890801999999999983 0.100416749463879573 -0.0174304809069394627 0.980948681762759955 0.16538542411701479 1305031527.00759506 -0.0200488230000000003 -0.00554057199999999968 -0.09790016 0.106515354426187481 -0.0179266069034269629 0.977364594734805747 0.181910871020021708 1305031527.03951192 -0.0234353750000000013 -0.00914814700000000057 -0.106970325000000005 0.113224901561134988 -0.0190224740942741034 0.973931019826736577 0.195644155969599248 1305031527.07148695 -0.0268078479999999987 0.00442536900000000018 -0.112307227999999995 0.120352435034275659 -0.0205858115190009384 0.969181800434609442 0.213958298394227864 1305031527.10749793 -0.0310707279999999988 0.00486450300000000006 -0.118102825999999994 0.125381435967296451 -0.0190312553878885585 0.966949073899550759 0.221194021885630032 1305031527.13947296 -0.030610107000000001 0.0082340759999999999 -0.122761726000000002 0.129590194799126229 -0.0204090004958983259 0.963641381198087954 0.2327770232504148 1305031527.17154002 -0.0329938119999999974 0.0180318879999999994 -0.13112579299999999 0.133578794805705448 -0.0192605694045513733 0.961256464190349047 0.240357538048499325 1305031527.20758796 -0.0367447099999999999 0.0205004740000000012 -0.137645884999999996 0.135950847336720138 -0.01729613691561524 0.961076970311077416 0.239894284829598708 1305031527.27150106 -0.0434453259999999994 0.041889957999999998 -0.136677355 0.137271211321250725 -0.0131129860306878343 0.962857487253339639 0.232142463543274391 1305031527.30747199 -0.046960509999999997 0.043947174999999998 -0.127684563000000001 0.13604061305283241 -0.0112199010043573331 0.965305805374883863 0.222602263086449287 1305031527.33963609 -0.045433633000000001 0.0504947980000000005 -0.122109099999999998 0.131844017608473529 -0.00687977518829437345 0.967865672489769735 0.214023044857652889 1305031527.53974104 -0.0406702160000000021 0.0686886089999999977 -0.0942803470000000005 0.128989607702871434 0.00739045104027097159 0.979327982336411607 0.155639857848090091 1305031527.67154694 -0.0597790590000000024 0.0861703830000000032 -0.0800275800000000009 0.124875025233463388 0.00804662107948116503 0.987459490753712754 0.096256085950777448 1305031527.70752001 -0.0629779169999999944 0.0803183019999999942 -0.0754213999999999996 0.118124430540813299 0.0106047177792244936 0.989585557398202087 0.0815756303017085849 1305031527.77146101 -0.0639681 0.0794579009999999974 -0.0706760210000000055 0.104486306413013499 0.0133050116705799373 0.992445444427947798 0.0629096834424131141 1305031527.80758095 -0.0671490579999999976 0.0713680240000000021 -0.0722353379999999962 0.096843057253499204 0.0147752011912445098 0.993918610864899521 0.0502882756509120607 1305031527.83960104 -0.0841456649999999945 0.0833857800000000066 -0.0651093499999999964 0.0916426060927993946 0.0160889281384837095 0.994409388752208856 0.0499274143265291334 1305031527.87146401 -0.0948576780000000008 0.0900550930000000027 -0.0660034570000000015 0.0808715809044888573 0.012684623828170212 0.995654092512565647 0.0444051323984745172 1305031527.9074769 -0.0992609259999999993 0.085766435000000002 -0.0582616850000000006 0.0672022532098003056 0.00914133975648400224 0.997098538438308757 0.0345658460792010042 1305031527.9395659 -0.114897556999999997 0.077028573000000003 -0.0580298009999999989 0.0548280499089733517 0.000756203026329067504 0.998086069750820482 0.0285921399955056492 1305031527.97150207 -0.125279635 0.0829155149999999952 -0.0613153950000000017 0.0383147708757181835 -0.0131664019572920749 0.998632487760730658 0.0330420728928212601 1305031528.03956008 -0.149975642999999992 0.084671959000000005 -0.0529502440000000005 0.00443556498217298045 -0.0460197808150414819 0.998252268987915192 0.0368091428520600436 1305031528.07154608 -0.160694851999999999 0.0878616420000000037 -0.0553810630000000012 -0.0121078120029755997 -0.0616678520151554069 0.997076631245040201 0.0434588120106803796 1305031528.10751295 -0.176289975999999987 0.0907570419999999961 -0.0554222200000000012 -0.0278695134746601847 -0.0779404133274437388 0.995353715952387086 0.049189046837764247 1305031528.13951302 -0.182451799999999997 0.0963398589999999999 -0.0556840970000000018 -0.0475689564339222756 -0.0964697999079930507 0.992633968922034593 0.055754603680671054 1305031528.17152309 -0.189394832000000013 0.0977570489999999986 -0.0567052590000000009 -0.0622204376415005159 -0.113738763000657744 0.989785101112525378 0.0593090595646924984 1305031528.20752692 -0.202431262000000001 0.0955468859999999975 -0.0615021209999999999 -0.071393286867100933 -0.133537348010525664 0.986344009532632571 0.064778624064716267 1305031528.23949289 -0.211042851000000004 0.0982791189999999981 -0.066208452000000001 -0.080469144557817493 -0.14846986233909637 0.9828485073852119 0.0740960746720367991 1305031528.27544999 -0.223710716000000004 0.104189500000000004 -0.0732756999999999992 -0.0931655297700753476 -0.159726720176927739 0.979374444558591795 0.081444805050611857 1305031528.30766511 -0.244773716000000002 0.107162124999999997 -0.0782576799999999961 -0.112386963377767449 -0.174391135034480171 0.974128121606721131 0.0896175495038307318 1305031528.33959293 -0.267502815000000005 0.119377657999999998 -0.0798698739999999935 -0.131352675383011236 -0.185550596303205667 0.968630652701606976 0.100359900000491956 1305031528.37543511 -0.277227013999999994 0.122483246000000004 -0.0864017980000000019 -0.156168524265171388 -0.190717032208737369 0.963421550312331787 0.105153801871891051 1305031528.40745902 -0.286472469999999979 0.125400484000000007 -0.0964349729999999933 -0.185297354247303009 -0.197440161197977665 0.956370767115123144 0.10971430655432915 1305031528.4394691 -0.294514090000000006 0.129935055999999993 -0.100482926 -0.217375927680142328 -0.202731514105905258 0.948014827437984153 0.113646496695909746 1305031528.47534204 -0.309931367999999985 0.129882887000000002 -0.129739462999999999 -0.24096266088637508 -0.210141203005541011 0.940934326890584094 0.111446235184977191 1305031528.53962588 -0.329695432999999982 0.143418118000000011 -0.155989199999999995 -0.298002071092221266 -0.219036376212898121 0.922438881953339451 0.111015046642073137 1305031528.57544899 -0.329237043999999979 0.149565578000000005 -0.154559985000000011 -0.328091901581889445 -0.223088823875202291 0.911774012186304383 0.106090675745080187 1305031528.60784101 -0.340293765000000026 0.151535481 -0.160942093000000008 -0.350554531114140921 -0.228903222339404411 0.902669204168785821 0.0995145384517894666 1305031528.63948703 -0.340425193000000015 0.165493459000000009 -0.169357075999999995 -0.372110553224519525 -0.231576029496044361 0.893679457350770257 0.0961421148665973918 1305031528.70744705 -0.339044899000000011 0.179300487000000008 -0.177713453999999993 -0.396103607091124132 -0.245452708381115436 0.881343811052284765 0.0780255542601921981 1305031528.739609 -0.342159747999999986 0.1895830039