Open m3d opened 4 years ago
Barometr by mohl byt logovany na strane ROSu. Do tech logu jsem se nikdy nedival. Sami si ho nepreposilame. Mohli bychom.
Pri poklesu dirou sebou dole drona triskla o zed. Je mozne, ze se tam Kalman rozbil a uz se nevzpamatoval.
Už dříve jsme pozorovali, že kontakt drony s kameny rozbíjí lokalizaci natolik, že se může i ztratit. Pokud tam byl tvrdší kontakt se zemí, tak by to považoval za velkého kandidáta na zdroj problémů.
Doufal jsem, ze to rozbiti lokalizace bude skokove. Pak by se ta drona mela dokazat vratit aspon k tomu mistu narazu. To se nestalo. To by znamenalo, ze se v Kalmanovi rozbiji nejen xyz, ktere uz se vzpamatovat nemuzou, ale i rychlosti a/nebo zrychleni, ktere by se vzpamatovat mely.
Krome barometru, ktery reportuje pro cloveka necitelny tlak, bych logoval i vystup prevodu do "pose".
Vrtam do Kalmana, jestli ho dokazu presvedcit, ze ma te vyskove souradnici opravdu opravdu verit. Porad nechapu, proc to tak neni. Jedna z moznosti je, ze potize zpusobuji nulove kovariacni matice reportovane z imu.
Jo, tak kovariacni matice by napr. pro linearni zrychleni mela obsahovat 1e-4: https://github.com/osrf/subt/blob/840975255690efaa16ca2d851ff8e606fc126648/submitted_models/ssci_x4_sensor_config_1/model.sdf#L184
Protoze tam ale je nula, UKF ji nahradi za 1e-9: https://github.com/cra-ros-pkg/robot_localization/blob/f6bf556407945e7b192c78959c51d2f10f62e488/src/ukf.cpp#L199
To je o pet radu moc nizke cislo. Dovedu si predstavit, ze to prehlasuje ostatni odhady / senzory.
Jdu vymyslet, co s tim a zkoumat, jestli to neco udela.
Pridal jsem poznamku s grafem z barometru k PR:
https://github.com/robotika/osgar/pull/676#issuecomment-706705644
skoro mam cukani (stejne jako to delame s IMU) vzit Z pouze z barometru a zbytek ignorovat. Minimalne uz zase zacina mit smysl sledovani 3D trace.
Jeste u techto propadu asi neni ani validni pozice reportovanych artefaktu ... necham na @jisa, ze by se idealne zlepsila ta pose3d
.
dik m.
Nemel bys k takovym grafum i popisky, co znamena ktera cara a co ktera osa?
Kdyz se mi nepodari presvedcit kalmana, ze ma Z verit, muzeme to "ohackovat" dalsim modulem, ktery vystup prepise. Zatim se mi do toho moc nechce, protoze lepsi Kalman zlepsi i dalsi osy a tomu bych dal prednost.
jj, labely jsou vzdy muj problem :( ... je tam Z, relativne laser dolu a nahoru a nove altitude
Asi jsem nasel chybu v nasem kodu, kvuli ktere Kalman altimetru neduveruje, nebo ho dokonce nepouziva vubec. Chvili do toho budu dal vrtat a pak se, snad jeste behem vecera, ozvu.
Jedna drona A250R s testem padu do diry. Tam spadne OK, ale problem je Z-ova souradnice po tom padu (!)
mota se tam dokolecka a "fiktivne stoupa", ale ve skutecnosti poletuje stale na stejnem miste. To by komplikovalo i pripadny 3D navrat. Mame logovany i ten barometr?