test readme math
This commit is contained in:
parent
55775d4b93
commit
591a1cb5cd
@ -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
|
||||
|
Loading…
Reference in New Issue
Block a user