LEGo color sorting robot optimized