Skip to content

Commit 7ca4d36

Browse files
Fix error in cart-pole dynamics
1 parent 626531c commit 7ca4d36

1 file changed

Lines changed: 1 addition & 1 deletion

File tree

class05/class05.jl

Lines changed: 1 addition & 1 deletion
Original file line numberDiff line numberDiff line change
@@ -476,7 +476,7 @@ begin
476476
q_2 = x[2]
477477
q_1_d = x[3]
478478
q_2_d = x[4]
479-
q_1_dd_numer = l * m_2 * sin(q_2) * q_2_d + u + m_2 * g * cos(q_2) * sin(q_2)
479+
q_1_dd_numer = l * m_2 * sin(q_2) * q_2_d^2 + u + m_2 * g * cos(q_2) * sin(q_2)
480480
q_1_dd_denom = m_1 + m_2 * (1 - cos(q_2) ^ 2)
481481
q_1_dd = q_1_dd_numer / q_1_dd_denom
482482
q_2_dd_numer = l * m_2 * cos(q_2) * sin(q_2) * q_2_d^2 + u * cos(q_2) + (m_1 + m_2) * g * sin(q_2)

0 commit comments

Comments
 (0)