Changed logging and added pose
renamed vision package