Added full sensor suite to SMP robots