Кажется, что мы должны вставить значения numeri c в контекст и получить соответствующее уравнение движения. Можно ли вставить значения symboli c и получить EoM, например, q1, q2?
context = plant.CreateDefaultContext()
plant.SetPositions(context, q)
if v is not None:
plant.SetVelocities(context, v)
M = plant.CalcMassMatrixViaInverseDynamics(context)
Cv = plant.CalcBiasTerm(context)
tauG = plant.CalcGravityGeneralizedForces(context)
B = plant.MakeActuationMatrix()
return (M, Cv, tauG, B)