New rtt-ros stuf + Several improvements