Update rosserial sketch and add message