====== RoboTeq Motor Controller Plugin ======
<note warning>
This plugin cannot be used together with the [[mobot>SMRDSerial_plug-in|SMRD-Serial plugin]], because they use the same variables between the [[mobot>RHD|RHD]] and MRC. There are no other know compatability issues with other plugins.
</note>
=== Gear ratio ===
The [[robots:armadillo:hardware:gearratio|gearing]] for the Armadillo is calculated based on the beltmodules. The gearing is calculated directly in the plugin so it is easy to make changes to the gearing. It can be considered to set the gearing via RHD-config file, bu the gearing should not change that often, so that may be a bad idea.

=== Speed Calculations ===
With the current configuration the speed is given in $\frac{cm}{s}$. This is recalculated with
$$v_{in}/100=v_{actual}$$

== Angular and Linear velocity ==
The relation between the linear speed and angular velocity is given by $v = r*\omega$ where $r$ is the radius of the circle and $\omega$ is the anguler velocity.

To change $\omega$ from RPM to $rad/s$ the following converson is done
$$1 RPM = 1\frac{rev}{min}*2\pi\frac{rad}{min}*\frac{1}{60}\frac{min}{s}=\frac{\pi}{30}\frac{rad}{s} $$

This constant is called $\frac{\pi}{30}\frac{rad}{s}=\Theta$

The angular velocity from the motor to the drivewheel is defines by $\omega=G*m_{RPM}$, $G=$ [[robots:armadillo:hardware:gearratio|Gear Ratio]]

Combine the above formulas and you get the following

$$v=r*\Theta*G*m_{RPM} -> m_{RPM}=\frac{v}{r*\Theta*G}$$

== Change RPM to control value ==

$$controlvalue=\frac{m_{rpm}}{max_{rpm}}*1000$$

$$max_{RPM}=8000$$