Database connection works
Using constructor to connect to db
Subscribing to amcl_pose topic and update a pose struct