В процессе программирования возникли некоторые трудности, которые оказались связанные с ошибкой сборки. Решил все перебрать, улучшить конструкцию для сборки и разборки, а также для того чтобы было удобно добавлять необходимые датчики. Также заменили камеру, установили более удобную и более качественную, также установил серво-привод для вращения камерой.
Теперь программировать и добавлять того чего захочется.