Compare commits
4 commits
main
...
Potentiome
Author | SHA1 | Date | |
---|---|---|---|
boutrie.eytan | 319dc1a04e | ||
boutrie.eytan | addd364b61 | ||
boutrie.eytan | f99cb0c0bb | ||
boutrie.eytan | 3b23142fc1 |
103
Rotabator.ino
103
Rotabator.ino
|
@ -1,77 +1,44 @@
|
|||
/*
|
||||
* Library: https://github.com/bolderflight/MPU9250
|
||||
Basic_I2C.ino
|
||||
Brian R Taylor
|
||||
brian.taylor@bolderflight.com
|
||||
int Pot; //Initialise la variable qui va recueillir la valeur du potentiomètre
|
||||
|
||||
Copyright (c) 2017 Bolder Flight Systems
|
||||
// Moteur branché sur l'interface 3
|
||||
int Moteur = 17;
|
||||
|
||||
Permission is hereby granted, free of charge, to any person obtaining a copy of this software
|
||||
and associated documentation files (the "Software"), to deal in the Software without restriction,
|
||||
including without limitation the rights to use, copy, modify, merge, publish, distribute,
|
||||
sublicense, and/or sell copies of the Software, and to permit persons to whom the Software is
|
||||
furnished to do so, subject to the following conditions:
|
||||
|
||||
The above copyright notice and this permission notice shall be included in all copies or
|
||||
substantial portions of the Software.
|
||||
|
||||
THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR IMPLIED, INCLUDING
|
||||
BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
|
||||
NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM,
|
||||
DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
|
||||
OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
|
||||
*/
|
||||
/*
|
||||
* Updated by Ahmad Shamshiri on July 09, 2018 for Robojax.com
|
||||
* in Ajax, Ontario, Canada
|
||||
* watch instrucion video for this code:
|
||||
For this sketch you need to connect:
|
||||
VCC to 5V and GND to GND of Arduino
|
||||
SDA to A4 and SCL to A5
|
||||
|
||||
S20A is 3.3V voltage regulator MIC5205-3.3BM5
|
||||
*/
|
||||
|
||||
#include "MPU9250.h"
|
||||
|
||||
float biai = 1.25;
|
||||
unsigned long previousTime;
|
||||
int interval = 300;
|
||||
int stepPin = 14;
|
||||
int dirPin = 12;
|
||||
bool pinState = LOW;
|
||||
// an MPU9250 object with the MPU-9250 sensor on I2C bus 0 with address 0x68
|
||||
MPU9250 IMU(Wire,0x68);
|
||||
int status;
|
||||
// Valeur pour le moteur (varie entre 0 et 255)
|
||||
int Valeur_Moteur;
|
||||
|
||||
void setup() {
|
||||
// serial to display data
|
||||
Serial.begin(115200);
|
||||
while(!Serial) {}
|
||||
|
||||
// start communication with IMU
|
||||
status = IMU.begin();
|
||||
if (status < 0) {
|
||||
Serial.println("IMU initialization unsuccessful");
|
||||
Serial.println("Check IMU wiring or try cycling power");
|
||||
Serial.print("Status: ");
|
||||
Serial.println(status);
|
||||
while(1) {}
|
||||
}
|
||||
pinMode(stepPin,OUTPUT);
|
||||
pinMode(dirPin,OUTPUT);
|
||||
Serial.begin(9600); //Initialise la communication entre le PC et Arduino
|
||||
pinMode(Moteur, OUTPUT);
|
||||
}
|
||||
|
||||
void loop() {
|
||||
// read the sensor
|
||||
digitalWrite(dirPin,HIGH);
|
||||
IMU.readSensor();
|
||||
// display the data
|
||||
|
||||
if((micros() - previousTime) >= interval){
|
||||
previousTime = micros();
|
||||
pinState = !pinState;
|
||||
digitalWrite(stepPin,pinState);
|
||||
Serial.println(IMU.getAccelX_mss() + IMU.getAccelY_mss() + IMU.getAccelZ_mss() + biai +11);
|
||||
}
|
||||
}
|
||||
//Lire la valeur du potentiomètre
|
||||
Pot = analogRead(6);
|
||||
|
||||
//Affiche la valeur du potentiomètre sur le moniteur série
|
||||
Serial.print("Potentiometre : "); Serial.println(Pot);
|
||||
|
||||
// Valeur min du potentiometre
|
||||
if (Pot < 1)
|
||||
{
|
||||
Pot = 0;
|
||||
}
|
||||
// Valeur max du potentiometre
|
||||
if (Pot > 8190)
|
||||
{
|
||||
Pot = 8191;
|
||||
}
|
||||
|
||||
//Definir la valeur à envoyer au moteur : 184 => 0 et 873 => 255)
|
||||
Valeur_Moteur = map(Pot, 0, 8191, 0, 255);
|
||||
|
||||
Serial.print("Moteur : "); Serial.println(Valeur_Moteur); //Affiche la valeur du potentiomètre sur le moniteur série
|
||||
|
||||
// Envoie de la valeur de sortie au moteur
|
||||
analogWrite(Moteur, Valeur_Moteur);
|
||||
|
||||
delay(200);
|
||||
|
||||
}
|
Loading…
Reference in a new issue