(sbpl_inteface) add ros duration pointer to bfs
add planning params
most of environment setup, add some tests