| 1 |
REQUIRE "atoms.a4l"; |
| 2 |
|
| 3 |
IMPORT "johnpye/extpy/extpy"; |
| 4 |
IMPORT "johnpye/fourbarplot"; |
| 5 |
|
| 6 |
(* |
| 7 |
Model of a four-bar linkage |
| 8 |
|
| 9 |
The pivots are at A, B, C, D. Sides are named after the |
| 10 |
end points. The 'default' configuration being modelled is |
| 11 |
of a quadrilater with A and D fixed and B and C free. |
| 12 |
The angle at A, alpha (to the positive x axis) will also be fixed |
| 13 |
|
| 14 |
*) |
| 15 |
|
| 16 |
MODEL fourbar; |
| 17 |
x_A,y_A IS_A delta_distance; |
| 18 |
x_B,y_B IS_A delta_distance; |
| 19 |
x_C,y_C IS_A delta_distance; |
| 20 |
x_D,y_D IS_A delta_distance; |
| 21 |
|
| 22 |
AB,BC,CD,DA IS_A distance; |
| 23 |
alpha, beta, gamma, delta IS_A angle; |
| 24 |
|
| 25 |
x_B = x_A + AB*cos(alpha); |
| 26 |
y_B = y_A + AB*sin(alpha); |
| 27 |
|
| 28 |
(x_C-x_B)^2 + (y_C-y_B)^2 = BC^2; |
| 29 |
beta = arctan((y_C-y_B)/(x_C-x_B)); |
| 30 |
|
| 31 |
x_D = x_C + CD*cos(gamma); |
| 32 |
y_D = y_C + CD*sin(gamma); |
| 33 |
|
| 34 |
x_A = x_D + DA*cos(delta); |
| 35 |
y_A = y_D + DA*sin(delta); |
| 36 |
|
| 37 |
METHODS |
| 38 |
METHOD default_self; |
| 39 |
y_B := 0.5 {m}; x_B := 0.8 {m}; |
| 40 |
y_C := -0.5{m}; x_C := 1.2 {m}; |
| 41 |
x_D := 2 {m}; y_D := 0 {m}; |
| 42 |
END default_self; |
| 43 |
|
| 44 |
METHOD specify; |
| 45 |
FIX x_A, y_A; |
| 46 |
FIX AB, BC, CD, DA; |
| 47 |
FIX alpha, delta; |
| 48 |
END specify; |
| 49 |
METHOD values; |
| 50 |
x_A := 0 {m}; |
| 51 |
y_A := 0 {m}; |
| 52 |
delta := 180 {deg}; |
| 53 |
AB := 1 {m}; |
| 54 |
BC := 1 {m}; |
| 55 |
CD := 1 {m}; |
| 56 |
DA := 2 {m}; |
| 57 |
|
| 58 |
alpha:= 30 {deg}; |
| 59 |
END values; |
| 60 |
METHOD fancyplot; |
| 61 |
EXTERNAL fourbarplot(SELF); |
| 62 |
END fancyplot; |
| 63 |
|
| 64 |
METHOD on_load; |
| 65 |
RUN reset; |
| 66 |
RUN values; |
| 67 |
RUN default_self; |
| 68 |
END on_load; |
| 69 |
END fourbar; |
| 70 |
|