Basic implementation of watchdog

Dependencies:   ros_lib_kinetic