Initial Vision Subsystem

docs/proto/left_front_high_cal.json

@@ -0,0 +1 @@
+{"camPath": "pci-0000:00:14.0-usb-0:1:1.0-video-index0", "K": [[2034.590941433994, 0.0, 880.1279510276863], [0.0, 2032.7045196994395, 630.4273890059455], [0.0, 0.0, 1.0]], "dist": [[-0.5007775764633813, 0.38115685265411103, -0.0005456402979672171, 2.8719061218650646e-05, -0.28200501157108276]], "r": [[[2.972117756001366], [0.14461463521871412], [0.2051843867678562]], [[2.976346568914756], [0.23618136821777133], [-0.011004260754996312]], [[2.9313347527816878], [0.1245670188893653], [0.21736439731412535]], [[2.9831102269987464], [0.2774023825146539], [-0.10210655730656817]], [[-3.034651941328638], [-0.18310560010666244], [0.37206263315551363]], [[-3.0400913655858255], [-0.2027056414133386], [-0.21878484520999084]], [[2.9260831401685823], [-0.056334444902433466], [-0.17709704304964902]], [[3.116451676909422], [0.018001175565074086], [-0.2030843786420336]], [[3.1603646058730632], [0.04952560917584767], [-0.07893097318946792]], [[3.0693260232304747], [0.012003050980828116], [-0.33013014878847036]], [[-3.0988908047036463], [-0.0026349035125346086], [0.7540646514030214]], [[-3.0828616520098397], [-0.04177945037342782], [0.7570951437027]], [[2.92963618271969], [-0.20906643862935176], [-0.021118076060076325]], [[2.9081347820429255], [-0.054508342238345234], [-0.20775352571590078]], [[-2.9944502120555043], [-0.0974660007075925], [0.20859245408012414]], [[-2.991604225331016], [-0.16618430388057884], [0.36095871193177326]], [[-3.1647079218898515], [-0.1197256387978939], [-0.06681525741634772]], [[-3.133978086548387], [-0.0668229776382041], [-0.5884984995812175]], [[-3.1746634391767574], [-0.03373356757748671], [-0.26403033239869633]], [[-3.2294211903313927], [-0.05589308388977673], [-0.05061969574589772]], [[2.9752856911979833], [-0.021532459817112902], [-0.034441233724952364]], [[3.020475519377276], [0.00848291976311943], [-0.02951042971265873]], [[2.8420541455379937], [0.1775015031780268], [-0.26926731174912194]], [[3.0411301890777023], [0.23377827328239245], [-0.060432079825883264]], [[2.874567453068982], [0.14057586507265857], [-0.24402056321187568]], [[3.0421239254262695], [0.04614734562548441], [-0.39411635247706095]], [[3.154349286507335], [0.1753188430858127], [-0.316130569284971]], [[3.0206219840931907], [0.13587413253742384], [-0.017050719942209303]], [[2.876355652576727], [-0.02220815749331801], [0.5867225945279473]], [[2.8803774135519844], [0.02731741020076287], [0.5421230687579255]], [[2.8932209039944987], [-0.004624007904559221], [0.4444522457303273]], [[2.9595492673308748], [0.028329370238695136], [0.2994896807116636]], [[2.982237131338564], [0.07876501144483136], [0.09466031735732094]], [[2.981568712440064], [-0.018927347209293437], [-0.09897072580124078]], [[2.970670293725353], [-0.04862152524125523], [-0.2063035380621412]], [[2.880816581490945], [-0.13177412382821968], [-0.5637792475897628]], [[3.0144099669645756], [0.06621071086537973], [-0.230297199089011]], [[-3.155074389751369], [-0.12298218860380952], [-0.04645944554082293]], [[-3.1431917168336865], [-0.08836088956338276], [0.4206967650206471]], [[3.1495229625708663], [0.02095550128008066], [-0.6257296996551143]], [[2.9204163962502543], [0.01309510069097413], [-0.021470959809245564]], [[2.9221752280834212], [0.03766236221409568], [-0.651480128784315]], [[3.071326058612229], [0.009224864436857225], [0.12739790801807374]], [[2.950911307103778], [0.0013390198212066898], [-0.23544531312282188]], [[3.0466295576473863], [-0.026281541713614617], [-0.46976024183046594]], [[3.0766944726335015], [-0.3029528811867967], [0.017345076126612954]], [[2.8482598821772678], [-0.21260860984921248], [-0.8613863790420112]], [[2.8974045798970547], [-0.1433271480008438], [-0.5878901071773455]], [[2.8501408291432955], [-0.06951082636874774], [1.0374726721229455]], [[3.000078112605787], [0.03539296673546452], [0.7634352403806183]], [[-3.1750532263196645], [0.016416531351811894], [-0.5174337878306529]], [[2.856200383449051], [0.19713715199652704], [-0.4672569630872221]], [[2.8214183076009323], [-0.05720780792646842], [-0.9100853851595009]], [[3.029374357187629], [0.07417549748961703], [-1.1095993033772744]], [[-3.0886846670226964], [-0.10258972091970397], [0.5239281213633235]], [[-3.1145820975756946], [0.10149127847486653], [0.2611126866063612]], [[3.079135736615356], [0.20522394792623588], [-0.28087531419612616]], [[-3.18897885768096], [-0.14285095589888833], [0.1630180951106511]], [[2.903341700499522], [0.1272163618109912], [-0.5564430206105668]], [[3.0246667569907792], [0.0819801534311009], [-0.014000027671272121]], [[3.042382994582923], [-0.05147660807048582], [-0.2609246509134782]], [[2.9102671903622053], [-0.07152095458323127], [-0.24291229924889665]], [[2.931073390931532], [-0.12435304994943698], [0.05856818484624456]], [[2.8610704155950386], [-0.09391958142310317], [-0.17620783678679758]], [[3.0651305223747602], [0.15549124416862942], [0.37777411736342953]], [[3.1338755726753007], [0.037245200615811457], [-0.005630331789504855]], [[3.0195443012830085], [0.1299702427594392], [-0.10163906692961021]]], "t": [[[-15.650736854493887], [6.857778837599344], [48.349947504859855]], [[-8.963145207009878], [6.085300426994423], [49.72262077243192]], [[-20.08641853717427], [0.521253620895347], [48.59781936398458]], [[-6.453722785084623], [-0.5827928649768352], [49.24301661773489]], [[-6.281855327921188], [8.615084539536763], [52.55464194454267]], [[-18.85081484500004], [8.695364084304813], [47.66369326722435]], [[-15.765607168666666], [3.046700426563041], [47.93257956524282]], [[-13.36245182299302], [-0.062235632398827186], [48.13480954543554]], [[-18.829468978035123], [-0.3989734879366773], [47.865805448953246]], [[-10.08789005608475], [1.328458954057217], [49.17936463274357]], [[-6.992449373607359], [9.91524759457669], [53.51368287630119]], [[-7.1624409458373455], [10.806010649941507], [53.40062764613071]], [[-15.059198746102396], [11.481255809027674], [43.817949411970176]], [[-18.717957054866556], [3.1966421371936846], [46.85594249919136]], [[-18.611270176245544], [1.6126055370429144], [47.12695131730127]], [[-17.747915897386896], [6.071767311351638], [45.427001488861244]], [[-18.125060378387847], [10.005992371995882], [41.99602235488049]], [[-16.92131413478499], [11.265054125558194], [37.61750739322918]], [[-12.819801142117816], [11.46298422454891], [41.56995479249915]], [[-7.920763794708833], [10.352222797011878], [41.71513365057442]], [[-7.346825856250467], [2.558199867361427], [40.38011419784057]], [[-16.78696859181067], [1.945338134743699], [40.49679428400943]], [[-8.393641592490933], [2.078959790954781], [75.3842074754267]], [[-30.206172711677276], [2.0316159586058857], [72.1442238940005]], [[-7.225369573134432], [4.824453396537377], [67.49294542088528]], [[-0.420402559354698], [4.658001669352664], [63.75050849081555]], [[-6.354866609519846], [1.3280136301798813], [53.34989559635866]], [[-5.528381256729115], [-0.7931718717161952], [51.34362539235489]], [[-20.085416176322173], [0.5888710363981801], [46.520868222372684]], [[-19.345890664306737], [-0.5726899449772573], [46.78296193480784]], [[-21.773465406300414], [-0.18244735644177376], [46.49685502760371]], [[-22.160956036930607], [-1.818269951896011], [47.53361557823163]], [[-17.553246497806885], [-2.9140933657222114], [50.544172407276534]], [[-9.253775448674263], [-1.023075405254654], [51.14450074693739]], [[-6.092706186897927], [-0.5164866668622652], [50.56555017187598]], [[-6.910135699056776], [9.555348134967167], [52.9196998902071]], [[-16.21746585066221], [8.131313687007715], [51.416558737811876]], [[-20.617314521576162], [9.459738157703816], [44.105908925163504]], [[-4.765387855533012], [12.574426158500536], [54.185365335941256]], [[-8.211961261330442], [3.065440307607229], [57.2500100231776]], [[-10.233666475704165], [6.141928992236385], [88.64370437832548]], [[-25.334644439581474], [-0.9990450448463851], [93.6198651808735]], [[-27.097064550306122], [-0.14668818995942523], [85.8786216802266]], [[4.325561740167578], [7.794731384543963], [79.95653717189911]], [[1.8474374986682065], [-4.165117395845179], [86.06565109873223]], [[-24.8233831318882], [-0.3719449714386675], [75.45024123922931]], [[-8.099737015411032], [8.170831295695054], [76.3438321455779]], [[-7.609510422376858], [14.274072863261452], [73.98833506969655]], [[-24.44876295536298], [3.9978128965407485], [53.88066941041532]], [[-26.392281649296592], [-2.8438830215025495], [55.89196922666568]], [[-25.510699807996772], [13.693751791998594], [54.649549710713764]], [[-8.8095189144662], [1.1687595424314456], [52.10702417926316]], [[-4.673937035315859], [4.027697871341497], [59.44231545601794]], [[-8.780996099482838], [-0.8792527257577493], [74.58200870109113]], [[-17.88617387960956], [17.302497588157593], [99.55820561166256]], [[-39.46392780311513], [19.76930573862205], [94.1183673454856]], [[-1.0444980269008128], [7.836860254194232], [96.74692048917085]], [[2.4863765757054788], [21.265809786200965], [92.09457976399098]], [[3.4973771854522275], [-6.2796613320691845], [97.31178457875373]], [[-29.421272575574466], [-4.922554376629262], [85.19741843711749]], [[-15.442136777585938], [-3.805301363229867], [84.74404335948034]], [[-14.429326153096456], [8.057912642291827], [98.67973649204387]], [[-28.502837172606554], [8.640830469524762], [93.74397066111203]], [[-34.59878778234068], [9.812452174688147], [94.71762325157394]], [[-4.3648345358781375], [6.312010033352869], [92.12095005512731]], [[3.635043656796955], [7.1847893988502145], [92.79411601893081]], [[3.121313192267437], [0.29965290076028167], [90.80928777817076]]], "reproj": 0.07817802795697237, "resolution": [1600, 1200], "timestamp": "2025-02-17 19:04:50.283875"}

docs/proto/left_servo_cal.json

@@ -0,0 +1 @@
+{"camPath": "pci-0000:00:14.0-usb-0:1:1.0-video-index0", "K": [[908.667484904358, 0.0, 788.9292626711189], [0.0, 907.7612107273449, 600.5577142958227], [0.0, 0.0, 1.0]], "dist": [[0.05860039588562758, -0.09926103008871819, -0.00029923249702769485, -0.0007110488647505913, 0.033992311176953754]], "r": [[[0.01708959763952807], [3.1066764619498173], [-0.28373965552941005]], [[-0.012101146688600843], [-3.0769036480309007], [0.1216148216260416]], [[0.014298101471690092], [3.0776941938220714], [-0.07165568951139943]], [[0.01556324543337185], [3.0975414201949243], [-0.16453244575464923]], [[0.008259897892452716], [3.0808505408538136], [-0.02918813541874695]], [[0.24511806711339595], [3.122534009026846], [-0.09676697125103548]], [[0.3048333378002546], [3.114372452040457], [-0.13789898306554826]], [[0.08606722295612744], [-3.134223333446275], [-0.07551105871905583]], [[-0.07794414768500942], [-3.13485567060615], [-0.056656374750222296]], [[-0.1405116296930595], [-3.077898763381189], [0.1036183804013022]], [[-0.11826276931641563], [-3.047097169760671], [0.05706613298131639]], [[-0.048934217440727595], [-3.111391936618772], [0.08460261221500895]], [[-0.24419735259882486], [-2.874442521218518], [-0.061063382175233695]], [[0.06547745733255005], [-3.0179621830786862], [0.09692226857792774]], [[0.008077908935851696], [3.073827923132955], [-0.052866236390603075]], [[-0.009230697428827775], [-3.0646754793538316], [0.14397619155453378]], [[-0.007244128592945403], [-3.0185819926610393], [0.13877482543209707]], [[-0.011605047868139842], [-3.044470544389751], [0.1105777305684842]], [[0.0028299164504184933], [2.9496228686795605], [-0.09091495789687122]], [[-0.0005993163273238655], [3.0160980762566174], [-0.03403058533439466]], [[0.2002582000150506], [-3.0564285522230548], [0.17152626087857448]], [[-0.14997306690848664], [-3.0705098423824118], [0.1247086864557807]], [[0.18082066211161066], [3.047678338369997], [-0.20312518659930995]], [[-0.07652385501553692], [3.1304444193970604], [-0.13156832190077838]], [[0.09968658949666151], [-3.0722239007565273], [0.2879206690886277]], [[0.057716120150259544], [-2.9874304360607273], [0.07249088504275197]], [[0.08352004672365419], [-2.8623949150525334], [0.02228882782737979]], [[0.20709261996043693], [-2.906528296445862], [0.04320421416792938]], [[-0.019998223544194536], [-3.0892512079745185], [0.13478711653466682]], [[-0.003007448980000043], [3.1238894457349087], [0.014548338888883506]], [[-0.00998234862355455], [-3.1513266428542392], [0.2015415264894833]], [[-0.03634496451392213], [-2.9521829921804756], [0.0931692716350578]], [[0.10597080378986488], [3.1197415181127877], [0.007477781476248389]], [[-0.08973942914247096], [-3.0432474713882693], [0.0026454821871140055]], [[0.06581650589211797], [2.8945769086962034], [-0.3023056534776636]], [[-0.06669042620831586], [-2.9855834047840646], [0.19231717652129962]], [[-0.0824449040117578], [-3.060021919155849], [-0.08053250070709317]], [[0.12296378334721336], [3.0099616037843315], [-0.13437718509261917]], [[0.12936232020155689], [-3.1229390876357965], [0.04960103746620885]], [[0.17360143867276723], [-3.1236916217960347], [-0.13469753194680695]], [[0.09051359900318924], [-3.0775489116324812], [-0.016131620088832174]], [[0.14996417947069446], [3.0814341303345985], [-0.0771846126993105]], [[0.27268644802257064], [2.803239099347612], [-0.2450457233258271]], [[-0.05087325313355352], [2.935150241323143], [0.06821166239592341]], [[0.14765356666155977], [2.990640710765321], [0.014830438832482987]], [[-0.08533953854239335], [-2.9060826281352616], [0.12895231200432897]], [[0.03917451994842752], [-2.9621914558487266], [-6.8279816892886625e-06]], [[-0.21971995763378654], [-2.8937376879227936], [0.11579227670927804]], [[0.061686078362830084], [-2.8300055375514583], [0.26622394084447154]], [[0.029782790804300303], [-3.0623157949144684], [0.1394461001442277]], [[0.02434214824507887], [-2.973158965441152], [0.34451597051136634]], [[-0.012111919587846335], [3.0906137999211283], [-0.3003991919146121]], [[0.06423283419312927], [-3.0160952146889164], [0.2995864976733363]], [[0.04959158730991548], [3.1437153548462655], [-0.34827048495061974]], [[0.01264626729180785], [-2.9802501928576115], [0.32471896336142325]], [[0.07484902306768355], [-2.943744645071098], [0.2568461014790691]], [[0.04290718766461925], [2.9743536335794105], [-0.5394401716237774]], [[0.019078237208410415], [3.048532416762353], [-0.2861642695444935]], [[0.011811879609799358], [3.1385266584750156], [-0.32269484988563785]], [[0.022843875833779587], [3.079016605007116], [-0.1455268486567791]], [[0.013014674964648311], [3.092515851170159], [-0.29268239906074967]], [[0.008697865786941629], [3.0894592919747463], [-0.3574362543144296]], [[0.01347033041341125], [3.0662236363927122], [-0.34579077291987503]], [[0.0964633623875692], [-3.0498860886765073], [0.5357760408720327]], [[0.1221886267598363], [-3.0156456383556534], [0.3520981774763901]], [[0.05985604731294491], [-3.033687593884458], [0.24054468751910174]], [[-0.14110633693310434], [-3.121700783568948], [0.26632418030759425]]], "t": [[[11.255746250523966], [-6.228528990898213], [56.154432651357155]], [[2.0309980861250274], [-6.421246035215185], [53.12347607354304]], [[0.24708666868375728], [-6.635277888851757], [39.33236960889902]], [[14.650248074450657], [-6.851020732809918], [34.49910484488878]], [[25.18796279464805], [-6.963343721071457], [33.94730207836129]], [[2.045868182660418], [-15.3367717661473], [38.140573697789485]], [[-5.271735585351751], [-15.675529837483628], [37.31423155927086]], [[14.60847647709072], [-12.744907554982127], [36.01288946695217]], [[24.364792565411214], [-12.381458804856464], [36.3067469240715]], [[21.998309127022974], [-14.522013339414544], [36.544532337853184]], [[21.301291528379355], [-21.939216978238136], [36.14448285231962]], [[14.944709335174457], [-18.73660546822585], [35.93230407509502]], [[3.4052492751333827], [-18.110925469755774], [31.681561565351767]], [[-2.552837853691686], [-16.94036197875656], [32.466544289937914]], [[12.938434190370995], [-6.10661175334262], [66.04957906465293]], [[-2.011792806279801], [-6.0340488379469255], [63.305816194858544]], [[-13.338752383858616], [-5.972523178050512], [62.57054737387954]], [[-21.853871269081914], [-5.917103674783385], [62.94857054885268]], [[25.09526659965938], [-6.228254316551207], [62.54135482324705]], [[33.55657402891661], [-6.320612432048879], [61.31406784111346]], [[30.31942811805321], [-19.84009945777402], [63.61425208840028]], [[23.724930693011633], [-22.444465821465513], [65.63241299175455]], [[30.370662484535547], [-22.606269249697256], [63.200866958664825]], [[43.02677033996023], [-22.071283118778894], [54.637429919023546]], [[25.072605803179027], [-22.01269002384017], [54.83781763867724]], [[11.617396675379846], [-22.062053717291242], [52.49897009430294]], [[2.6381235631798963], [-22.342857525444536], [53.121402302485]], [[9.961839300699372], [-20.09309514518559], [51.94605151841695]], [[-9.623083590537616], [-22.247464975065526], [53.19546169820401]], [[27.553471950826818], [-6.369505900445974], [63.39324929634588]], [[-21.04512684431377], [-5.990254109889054], [58.124566433479174]], [[10.77313968369506], [-7.504412202393244], [23.53807379756939]], [[16.92806730584147], [-18.53886656642328], [33.630573018395346]], [[19.974011922907977], [-20.585661391925537], [32.637123154592196]], [[7.5680410265188875], [-7.142057006440287], [28.627833626593393]], [[29.357110315386926], [-30.958332839109744], [87.40828372675352]], [[16.551145100699213], [-30.937905969522205], [64.46843941393806]], [[4.680328896624454], [-31.23895224826385], [67.33773507909748]], [[5.907686708031065], [-35.535502344165785], [65.33338252098268]], [[-10.092149860565426], [-34.864274796749186], [64.59353079071737]], [[-25.336791004164336], [-34.03874088416885], [62.012106242976735]], [[-21.03653171185467], [-29.58060300362278], [66.98102085354758]], [[-15.237949487591306], [-29.092836137992], [72.57520939186406]], [[-11.198629284605406], [-29.170291001191504], [69.34264084568063]], [[-26.238349903682685], [-31.397344411558315], [65.79321680747394]], [[25.32774763111954], [-29.577901157341625], [61.36853914626458]], [[14.535713565688763], [-28.76881043485494], [61.46261377495044]], [[36.27687452876517], [-31.37039329455821], [63.289094790754376]], [[33.37673734039401], [-15.436013835698153], [56.85362085009581]], [[41.56711574511026], [-16.129712925495543], [58.48824794221913]], [[21.031283268687293], [-13.75447906561627], [63.36903938080954]], [[0.5880940981222447], [-13.275732668959737], [61.66861259306706]], [[-2.5297182368590705], [-13.250747403912515], [58.467875621222134]], [[-10.719375432658744], [-13.683276496425558], [60.47328353871305]], [[-16.067864987667626], [-13.359564496426982], [59.602969317025575]], [[-21.76195801816655], [-12.151915484974639], [58.079113212292185]], [[-7.410775743503267], [-5.353827833645429], [54.860649129955185]], [[-13.200145821492955], [-6.020902026435965], [51.661566273467315]], [[3.7886406503795156], [-6.176895133975448], [50.614728106450094]], [[14.797927614035768], [-6.41795208132265], [54.97222591922958]], [[24.079043558750307], [-6.279104189194652], [56.21323465820686]], [[34.3086435705577], [-6.195086341056795], [56.75089365311261]], [[37.66435214036778], [-6.248961974005903], [56.57714702093321]], [[19.290432543617207], [-13.751877034985329], [65.34272150733918]], [[10.935230597783589], [-16.533663472551503], [66.15087645210647]], [[4.263481186670238], [-16.286655338966504], [67.28196508004051]], [[19.065944109537185], [-16.891839039907893], [68.4629080707033]]], "reproj": 0.15416319457295144, "resolution": [1600, 1300], "timestamp": "2025-02-20 18:53:43.383888"}