1 #LyX 1.3 created this file. For more info see http://www.lyx.org/
15 \use_numerical_citations 1
16 \paperorientation portrait
21 \paragraph_separation indent
23 \quotes_language english
27 \paperpagestyle default
31 Equations\SpecialChar \ldots{}
35 This document used to contain figures and other stuf, now it's only for
36 testing editing of equations.
42 Note that the asymmetry has been introduced via the parameter
43 \begin_inset Formula $\gamma$
46 according to the following transformation
47 \begin_inset Formula \[
48 \left\{ \begin{array}{c}
49 r=\frac{r_{1}+r_{2}}{2}\\
50 \gamma=\frac{r_{1}-r_{2}}{r_{2}+r_{1}}\end{array}\right\} \,\leftrightarrow\,\left\{ \begin{array}{c}
51 r_{1}=\left(1+\gamma\right)r\\
52 r_{2}=\left(1-\gamma\right)r\end{array}\right\} \]
57 \begin_inset Formula $r_{1}$
61 \begin_inset Formula $r_{2}$
64 are the distances from
65 \begin_inset Formula $A$
68 to the left and right feet respectively.
69 In case of possible future use, I provide some relationsships as follows:
70 \begin_inset Formula \begin{eqnarray*}
71 r_{1}+r_{2} & = & 2r\\
72 r_{1}-r_{2} & = & 2\gamma\\
73 r_{1}*r_{2} & = & \left(1-\gamma^{2}\right)r^{2}\\
74 \frac{r_{1}}{r_{2}} & = & \frac{1+\gamma}{1-\gamma}\\
75 r_{1}^{2}+r_{2}^{2} & = & 2\left(1+\gamma^{2}\right)r^{2}\\
76 r_{1}^{2}-r_{2}^{2} & = & 4\gamma r^{2}\end{eqnarray*}
86 More general definition of ground force
89 Assume that the ground force on foot
90 \begin_inset Formula $P_{i}$
94 \begin_inset Formula \begin{eqnarray*}
95 \overline{f}^{G_{l}}\left(\overline{r}^{NP_{l}};\,\overline{r}^{NC_{l}^{0}},\overline{\overline{K}}^{l}\right)=\,\,\,\,\,\,\,\,\,\,\\
97 \overline{f}^{Gnd}\left(\overline{r}^{NP_{l}};\,\overline{r}^{NC_{l}^{0}},\overline{\overline{K}}^{l}\right) & \textrm{if}\,\textrm{ }\left(\overline{r}^{NC_{l}^{0}}-\overline{r}^{NP_{l}}\right)\cdot\overline{n}_{3}>0\\
98 \overline{0} & \textrm{otherwise}\end{cases}\end{eqnarray*}
103 \begin_inset Formula \[
104 \overline{f}^{Gnd}\left(\overline{r};\,\overline{r}^{0},\overline{\overline{K}}\right)=\overline{\overline{K}}\cdot\overline{r}\]
109 \begin_inset Formula $\overline{\overline{K}}^{l}=k^{l}\overline{n}_{3}\overline{n}_{3}$
113 Note that only the static case is considered here, so any velocity dependant
114 arguments have been removed.
115 Furthermore, the ground force is uni-lateral, i\SpecialChar \@.
117 here it is always directed
121 Let us be convenient and consider the centre of mass as foot
122 \begin_inset Formula $0$
128 \begin_inset Formula $P_{0}=B$
131 and denote the corresponding force
132 \begin_inset Formula $\overline{f}^{G_{0}}\left(\overline{r}\right)=-mg\overline{n}_{3}$
136 Then the force equilibrium constraint can be written as follows
137 \begin_inset Formula \begin{equation}
138 \sum_{l=0}^{L}\overline{f}^{G_{l}}=\overline{0}\label{eq: force equlibrium}\end{equation}
142 and the moment equilibrium constraint around an aribtrary point
143 \begin_inset Formula $A$
146 can be written as follows
147 \begin_inset Formula \begin{equation}
148 \sum_{l=0}^{L}\overline{r}^{AP_{l}}\times\overline{f}^{G_{l}}=\overline{0}.\label{eq: moment equilibrium}\end{equation}
155 Depending on the number of feet in contact with ground, these constraints
157 For instance, the case without any feet att all in contact with the ground,
159 \begin_inset Formula \[
160 \sum_{l=0}^{L}\overline{f}^{G_{l}}=\overline{f}^{G_{0}}=mg\overline{n}_{3}\neq\overline{0}\]
164 and hence no equlibria are possible.
167 Assume that only one foot, say foot
168 \begin_inset Formula $l$
171 , supports the robot, i\SpecialChar \@.
174 \begin_inset Formula \[
175 \overline{f}^{Gnd_{i}}=\begin{cases}
176 \overline{f}^{Gnd_{l}} & \textrm{if}\, i=l\\
177 \overline{0} & otherwise\end{cases},\]
182 \begin_inset LatexCommand \ref{eq: force equlibrium}
187 \begin_inset LatexCommand \ref{eq: moment equilibrium}
192 \begin_inset Formula \begin{equation}
193 \overline{f}^{Gnd_{l}}=-\overline{f}^{G_{0}}\label{eq: force equlibrium, w only foot l}\end{equation}
198 \begin_inset Formula \begin{equation}
199 \overline{r}^{AP_{l}}\times\overline{f}^{G_{l}}=-\overline{r}^{AP_{0}}\times\overline{f}^{G_{0}}.\label{eq:moment equlibrium, w only foot l}\end{equation}
204 By letting the arbitrary point
205 \begin_inset Formula $A$
209 \begin_inset LatexCommand \ref{eq:moment equlibrium, w only foot l}
214 \begin_inset Formula $P_{0}$
220 \begin_inset Formula $B,$
224 \begin_inset Formula $\overline{f}^{G_{l}}=\overline{f}^{G_{0}}\shortparallel\overline{r}^{BP_{l}}$
230 \begin_inset Formula $l$
233 must be directly below the centre of mass.
234 The distance will of course be given by the solution to (
235 \begin_inset LatexCommand \ref{eq: force equlibrium, w only foot l}
240 This kind of equilibrium, with only a single point in contact with the
241 ground will from now on be refered to as an
246 Since the centre of mass is directly over the only supporting foot, it
247 is easy to see from figure\SpecialChar ~
249 \begin_inset LatexCommand \ref{Fig: Extreme equilibrium, existance}
253 that in the planar configuration, the equlibrium angle
254 \begin_inset Formula $\alpha^{*}$
258 \begin_inset Formula $-\alpha_{1}$
262 \begin_inset Formula $\alpha_{2}$
266 In figure\SpecialChar ~
268 \begin_inset LatexCommand \ref{Fig: Extreme equilibrium, existance}
273 \begin_inset Formula $\alpha^{*}=\alpha_{2}$
279 The reasoning above assumed that there was only one foot supporting the
280 robot, and thus showed that any equlibrium must be directly above that
282 This reasoning can be reversed.
283 Assume that there exists an equlibrium where the centre of mass is directly
284 above foot\SpecialChar ~
285 two, one of two feet.
287 \begin_inset Formula $A=P_{2}$
291 \begin_inset LatexCommand \ref{eq: moment equilibrium}
296 \begin_inset Formula \[
297 \underbrace{\overline{r}^{P_{2}P_{0}}\times\overline{f}^{G_{0}}}_{=\overline{0}}+\overline{r}^{P_{2}P_{1}}\times\overline{f}^{G_{1}}+\underbrace{\overline{r}^{P_{2}P_{2}}\times\overline{f}^{G_{l}}}_{=\overline{0}}=\overline{r}^{P_{2}P_{1}}\times\overline{f}^{G_{1}}=\overline{0.}\]
301 When can this be satisfied? A general solution is given by
302 \begin_inset Formula $\overline{f}^{G_{1}}=f^{1}\overline{r}^{P_{2}P_{1}}$
306 \begin_inset Formula $f^{1}\in\Re$
310 The most typical solution is of course
311 \begin_inset Formula $f^{1}=0$
317 \begin_inset Formula $\overline{f}^{G_{1}}=\overline{0}$
320 , which corresponds to only one supporting foot.
322 \begin_inset Formula $\overline{r}^{P_{2}P_{1}}=\overline{0}$
325 the equation is also satisfied, corresponding to two feet in the same place.
326 A third alternative (illustrated in figure\SpecialChar ~
328 \begin_inset Formula $f^{1}\neq0$
332 \begin_inset Formula $\overline{r}^{P_{2}P_{1}}\neq\overline{0}$
335 can sometimes also exist.
336 First note that since ground forces by assumption must be directed upwards,
338 \begin_inset Formula $f^{1}\overline{r}^{P_{2}P_{1}}$
341 also must be directed upwards.
343 \begin_inset Formula $f^{1}>0$
347 \begin_inset Formula $P_{1}$
350 must be located somewhere
355 \begin_inset Formula $P_{2}$
359 \begin_inset Formula $f^{1}>0$
363 \begin_inset Formula $P_{1}$
366 must be located somewhere
371 \begin_inset Formula $P_{2}$
375 Inserting this into the force equlibrium (
376 \begin_inset LatexCommand \ref{eq: force equlibrium}
380 ) and scalar multiplying with a vertical and horizontal unit vector produces
381 the following equation:
382 \begin_inset Formula \[
383 ^{N}f^{Gnd}\left(\overline{r}^{NC_{2}};\,\overline{r}^{NC_{2}^{0}},\overline{\overline{K}}^{2}\right)=\left[\begin{array}{c}
386 mg\end{array}\right]-f^{1}\left(n\cdot b^{T}\right)\{^{B}r^{P_{2}P_{1}}\}\]
390 Sigh\SpecialChar \ldots{}
391 this is more complicated than I thought...
392 Anyway, at least when only vertical forces are allowed, the third alternative
393 is impossible and the second disregarded since the foot feet can then just
394 be considered as one foot.
398 In a configuration with more than two feet, we will get the same result
399 for a foot on the edge of a convex support area .
400 Note however that there can exist an equilibrium where the centre of mass
401 is above one of the supporting feet.
402 Consider for instance a symmetric and planar case with three eqally spaced
404 If the foot stiffnesses are equal, and the ground horizontal, then it should
405 be obivous that the centre of mass directly above middle foot is an equlibrium.
406 The definition of an extreme equlibrium is therefore refined:
411 projected\SpecialChar ~
412 support\SpecialChar ~
415 is a unique region in any normal plane (w\SpecialChar \@.
418 gravity), defined as the convex
419 hull of the projection of all supporting feet into that plane.
425 extreme\SpecialChar ~
428 is any equlibrium, where the projection of the centre of mass along the
429 direction of gravity belongs to the boundary of the projected support region.
432 singular extreme equlibrium
434 is an extreme equlibrium where the centre of mass is directly above one
435 of the supporting feet.
438 From the results above, a singular extreme equlibrium can only be supported