From 591a1cb5cda71879573ca1e69c3136c942e7f4f8 Mon Sep 17 00:00:00 2001 From: Lucien Renaud Date: Tue, 24 May 2022 19:23:55 +0200 Subject: [PATCH] test readme math --- README.md | 9 +++++---- 1 file changed, 5 insertions(+), 4 deletions(-) diff --git a/README.md b/README.md index 005fbc0..1f487aa 100644 --- a/README.md +++ b/README.md @@ -49,14 +49,15 @@ We can see that in the first movement (positive rotation), the green is out of p Since the 2 signals correspond to a cos and sin signals, it is possible to compute the angle inside the period using arctan2 function. However, we have more than one period, it is so necessary to increment a position. -$\theta= atan2(a,b)$ - +```math +$$\theta= atan2(a,b)$$ +\theta= atan2(a,b) +``` 2. Incremental position To increment the position, it is necessary to start from 0 at a known postion. For that the motor is moved in open loop to one end and the position is set to 0. Then we need to sum all the delta of movement at each measure sample. - -$\phi_t=\phi_{t-1} + (\theta_t - \theta_{t-1})mod(-\pi;\pi)$ +$$\phi_t=\phi_{t-1} + (\theta_t - \theta_{t-1})mod(-\pi;\pi)$$ ## Coding the solution 1. Get the angle in the perdiod