Software for our lego robots