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:

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

Popular posts from this blog

Flip address is out of range arduino uno r3

Arduino Uno not uploading

Indesign and MathType fonts