ROSJAVA gui for #23 almost working