Fixing orocos bug