Added uarm_pub to publish msgs via command line. Couldnt really test it cause gztopic echo doesnt work with costum messages.