Please help in programming
please help. programming wrong, not know find , solve error.
the mpu6050 detects tilt , send bluetooth (hc-05), car telling movement car has perform.
command material:
arduino nano
hc-05 (bluetooth)
mpu-6050
voltage regulator
the sketch (car command) follows:
car material:
arduino uno
driver motor ponte h l298n
hc-05
and sketch (car) follows:
the mpu6050 detects tilt , send bluetooth (hc-05), car telling movement car has perform.
command material:
arduino nano
hc-05 (bluetooth)
mpu-6050
voltage regulator
the sketch (car command) follows:
code: [select]
#include<wire.h>
#include <softwareserial.h>
softwareserial myserial(10, 11); // rx, tx
const int mpu=0x68; // i2c address of mpu-6050
int acx,acy,acz;
void setup(){
//comunicação com o acelerometro
wire.begin();
wire.begintransmission(mpu);
wire.write(0x6b); // pwr_mgmt_1 register
wire.write(0); // 0 para wakes mpu-6050)
wire.endtransmission(true);
serial.begin(9600); //para serial terminal fazer debug e ler valores acelerometro
myserial.begin(38400); //para envio por bluetooth
}
void loop(){
//leitura dos valores modulo gy-521
wire.begintransmission(mpu);
wire.write(0x3b); // register 0x3b (accel_xout_h)
wire.endtransmission(false);
wire.requestfrom(mpu,14,true);
acx=wire.read()<<8|wire.read(); // 0x3b (accel_xout_h) & 0x3c (accel_xout_l)
acy=wire.read()<<8|wire.read(); // 0x3d (accel_yout_h) & 0x3e (accel_yout_l)
acz=wire.read()<<8|wire.read(); // 0x3f (accel_zout_h) & 0x40 (accel_zout_l)
//compara os valores obtidos acelerometro, executa função pretendida
if ((acx/1000)<-5) {serial.println("tras"); myserial.print("b");} else
if ((acx/1000)>5) {serial.println("frente"); myserial.print("f");} else
if ((acz/1000)<-5) {serial.println("esquerda"); myserial.print("l");} else
if ((acz/1000)>5) {serial.println("direita"); myserial.print("r");} else myserial.print("s");
delay(5);
//debug
// serial.print(acy/1000);
// serial.print(" ");
// serial.print(acx/1000);
// serial.print(" ");
// serial.println(acz/1000);
// delay(1000);
}
car material:
arduino uno
driver motor ponte h l298n
hc-05
and sketch (car) follows:
code: [select]
// portas para comunicação rx, tx para o arduin
char state; //para guardar o valor recebido por bluetooth
///////declaração de saidas para os reles para controlo de mov de motores dc /
int mtr0 = 2; //saida para o relé 0
int mtr1 = 3; //saida para o relé 1
int mtr2 = 7; //saida para o relé 2
int mtr3 = 8; //saida para o relé 3
//
void setup() {
// inicializa portas serial para o terminal e para o bluetooth para iniciar
serial.begin(9600);
pinmode(mtr0, output);
pinmode(mtr1, output);
pinmode(mtr2, output);
pinmode(mtr3, output);
// declara o estado inicial das portas de saida
digitalwrite(mtr0,high);
digitalwrite(mtr1,high);
digitalwrite(mtr2,high);
digitalwrite(mtr3,high); }
void loop() {
if (serial.available()) {
// se comunicaçao disponivel
state = serial.read();// le o valor recebido pelo bluetooth,
// direita /////////////////////////////////////////
if (state == 'f' || state == 'f') {
digitalwrite(mtr0,low);
digitalwrite(mtr1,high);
digitalwrite(mtr2,high);
digitalwrite(mtr3,low); }
// esquerda /////////////////////////////////////////
if (state == 'b' || state == 'b') {
digitalwrite(mtr0,high);
digitalwrite(mtr1,low);
digitalwrite(mtr2,low);
digitalwrite(mtr3,high); }
// frente /////////////////////////////////////////
if (state == 'r' || state == 'r') {
digitalwrite(mtr0,low);
digitalwrite(mtr1,high);
digitalwrite(mtr2,low);
digitalwrite(mtr3,high); }
// tras /////////////////////////////////////
if (state == 'l' || state == 'l') {
digitalwrite(mtr0,high);
digitalwrite(mtr1,low);
digitalwrite(mtr2,high);
digitalwrite(mtr3,low); }
// parar/////////////////////////////////////////
if (state == 's' || state == 'w') {
digitalwrite(mtr0,low);
digitalwrite(mtr1,low);
digitalwrite(mtr2,low);
digitalwrite(mtr3,low); }
delay(100);
}
programming wrong,that not provide information provide basis helping you.
also please modify post , use code button </>
code: [select]
so code looks this
, easy copy text editor. see how use forum code long me study without copying text editor....r
Arduino Forum > Using Arduino > Programming Questions > Please help in programming
arduino
Comments
Post a Comment