thesis/unicycle.m

function dx = unicycle(t, x, u)
    % u is (v;w)
    % x is (x; y; theta)
    theta = x(3);
    G_x = [cos(theta), 0; sin(theta), 0; 0, 1];
    dx = G_x*u;
end