chào bạn, mình thấy nếu giải bài toán động lực học bạn nên dùng phương pháp ma trận Jacobian sẽ bao quát và dễ giải quyết hơn. Nếu bạn muốn mô phỏng thì mình có một gợi ý đó là bạn nên sử dung phần mềm Easy-rob, đơn giản, chính xác, dễ sử dụng. Đây là kết quả mình đã mô phong elbow và scara, bạn có thể xem và cho ý kiến. Cảm ơn!
http://www.youtube.com/watch?v=w84_8hbe9cg
http://www.youtube.com/watch?v=kOsvM0DoB6c