first version with orocos-ros integration