23 lines
674 B
C
23 lines
674 B
C
/*********************************************
|
|
Utilitaires de conversions physique -> steps
|
|
*********************************************/
|
|
|
|
// Convertit une longueur en cm vers un nombre de pas moteur.
|
|
// ex:
|
|
// float distance = 22.3; //cm
|
|
// int steps = convertLengthToSteps(distance);
|
|
int convertLengthToSteps(float length)
|
|
{
|
|
float result = length * 512 / (4 * 3.1415);
|
|
return int(result);
|
|
}
|
|
|
|
// Convertit une rotation en degrés vers un nombre de pas moteur.
|
|
// ex:
|
|
// float angle = 45; //deg
|
|
// int steps = convertRotToSteps(angle);
|
|
int convertRotToSteps(int rotation)
|
|
{
|
|
int result = convertLengthToSteps(rotation * 3.1415 / 180 * 7.8);
|
|
return result;
|
|
} |