Dense Constraints Updates#358

LBern wants to merge 4 commits intodevelopethz-asl/maplab:developfrom

feature/dense_constraintsethz-asl/maplab:feature/dense_constraintsCopy head branch name to clipboard