UPDATE:add battery node test code, work with roscore