Now, external localization (AMCL) is treated as an estimated pose with a fixed cov instead of a fixed information

Added solve function. Fixed some bugs on frames visualization and Ceres problem building. AMCL mapping working

[WORK IN PROGRESS] Added publisher, subscribers and tf2 listener and broadcaster. Added new_estimated_pose code.