Feature addition for team Torvald's SE2 code