Complete restructure of Indexer and Robot Controller improvement

Finally, a fully working and automated version