Added init to local_plannner