BIRDy/Benchmark/Robot_Data_Generation/Dynamic_Model_Generation/Utils/timeDerivative.m

23 lines
475 B
Matlab

function [ A_dot ] = timeDerivative(A, Var, Var_diff)
% Authors: Quentin Leboutet, Julien Roux, Alexandre Janot and Gordon Cheng
%
% Returns the symbolic expression of the time-derivative of matrix A with respect
% to the variables Var.
[m,n] = size(A);
A_dot = sym(zeros(size(A)));
for i = 1:m
for j = 1:n
tmp = sym(0);
for k = 1:n
A_dot(i,j) = A_dot(i,j) + diff(A(i,j),Var(k))*Var_diff(k);
end
end
end
A_dot = combine(A_dot);
end