1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
|
# pendulum on a cart
# uses DAE solver to solve for x'', th1''
#
# pend-cart1.ode
#
# masses of cart and pendulum (kg)
par mc=5,mp=1
# length (m) and gravity
par l=1,g=9.8
# simple linear friction
par muc=0.01,mup=0.1
# set up DAEs
0=(mc+mp)*xdd+mp*l*cos(th1)*th1dd-mp*l*sin(th1)*th1p^2+muc*xp
0=cos(th1)*xdd+l*th1dd+g*sin(th1)+mup*th1p
solv xdd=0
solv th1dd=0
#
#
# dynamics
x'=xp
xp'=xdd
th1'=th1p
th1p'=th1dd
#
# the physics isn't quite right, but now I will add a kick
global 1 th1p {th1=th1-kick;x=x+r*kick}
par kick=.05,r=0
# track accelerations
aux xpp=xdd
aux th1pp=th1dd
@ dt=.02
# nice ICs
init th1=1.5
done
|
