Сделайте этот шаг за шагом:
1. Нарисуйте диаграмму свободного тела, выпишите уравнения для всех сил как функцию смещения, скорости и ускорения каждого элемента (включая, очевидно, вращение). Например, вы знаете, что сила на коробке m будет * c * dy / dt * плюс все, что испытывает шкив.
2. Сначала рассортируйте вращение стержня. Вы знаете, что * T = I * d (омега) / dt *, если вы избавляетесь от остальной части системы. Итак, сделайте что-то похожее на пример автомобильного двигателя MatLab: разделите входное значение T на I , чтобы получить ускорение, интегрируйте его, чтобы получить скорость и еще раз, чтобы получить вращательное смещение.
3. Продолжайте добавлять биты один за другим. Во-первых, вы знаете, что будет момент, пропорциональный действию k * (theta_1-theta_2) . Это будет противодействовать движению стержня 1 и будет создавать движение стержня 2. Добавьте новую «ветвь» к вашей модели, чтобы получить theta_2 так же, как вы получили theta_1.
4. Продолжайте включать другие элементы ...