229 | | $$InnerLinkJointAngle = JP_{cts@worm} * \frac{1_{Rev@worm}}{4096_{cts@worm}} * \frac{1_{Rev@joint}}{50_{Rev@worm}} * \frac{2\pi_{rad}}{1_{Rev@joint}}$$ |
230 | | |
231 | | $$OuterLinkJointAngle = P_{cts@motor} * \frac{1_{Rev@motor}}{4096_{cts@motor}} * \frac{16_{teeth}}{1_{Rev@motor}} * \frac{1_{Rev@worm}}{30_{teeth}} * \frac{1_{Rev@joint}}{50_{Rev@worm}} * \frac{2\pi_{rad}}{1_{Rev@joint}} + InnerLinkJointAngle + \frac{2\pi}{9}$$ |
| 229 | $$InnerLinkJointAngle_{wrtPalm} = JP_{cts@worm} * \frac{1_{Rev@worm}}{4096_{cts@worm}} * \frac{1_{Rev@joint}}{50_{Rev@worm}} * \frac{2\pi_{rad}}{1_{Rev@joint}}$$ |
| 230 | |
| 231 | $$OuterLinkJointAngle_{wrtPalm} = P_{cts@motor} * \frac{1_{Rev@motor}}{4096_{cts@motor}} * \frac{16_{teeth}}{1_{Rev@motor}} * \frac{1_{Rev@worm}}{30_{teeth}} * \frac{1_{Rev@joint}}{50_{Rev@worm}} * \frac{2\pi_{rad}}{1_{Rev@joint}} + InnerLinkJointAngle + \frac{2\pi}{9}$$ |