Mechanicum robot WIP