some programs I made for the roborugby module in UCD Engineering, hope it helps:)