Sorted beachmap vector by angle of poles
Found good parameter for k_s. Odometry should be integrated fine.
Changed Pole class to also contain struct for 3D pole
Added serial_com.h include
Implemented pole scanning with active laser suspension as well as 3D poles
Reimplemented translation of poles to be on [0 0] and [x 0]
Implemented new first pose calculation with non-linear regression which is more robust
Used wrong timestamp to check if poles are visible
Kein Bock mehr auf den Scheiss
Corrected error in minimizing scans
Corrected serial message to include set command
Fixed serial communication not setting the correct baud rate OH YEAH!!!
Everything compiles
Merge branch 'experimental' into localization

Conflicts:
	src/locate.cpp