0

今年合格するかどうかを決定する学校のプロジェクトでは、MPU-6050 と Arduino Due を使用する必要があります。MPU は I2C 経由で動作し、その部分が動作しています。値とそのリンクを取得できます。しかし、問題が 1 つあります。私のコードでは、正しい値を取得していないようです! または、私がそれらを間違って処理していること。Arduino C コードと私のコードをお見せします。おそらく誰かが私が間違っていることを知っているでしょう。

出力付きのarduinoコードは次のとおりです。

#include<Wire.h>
const int MPU_addr=0x68;  // I2C address of the MPU-6050
int16_t AcX,AcY,AcZ,Tmp,GyX,GyY,GyZ;
void setup(){
  Wire.begin();
  Wire.beginTransmission(MPU_addr);
  Wire.write(0x6B);  // PWR_MGMT_1 register
  Wire.write(0);     // set to zero (wakes up the MPU-6050)
  Wire.endTransmission(true);
  Serial.begin(9600);
}
void loop(){
  Wire.beginTransmission(MPU_addr);
  Wire.write(0x3B);  // starting with register 0x3B (ACCEL_XOUT_H)
  Wire.endTransmission(false);
  Wire.requestFrom(MPU_addr,14,true);  // request a total of 14 registers
  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)
  Tmp=Wire.read()<<8|Wire.read();  // 0x41 (TEMP_OUT_H) & 0x42 (TEMP_OUT_L)
  GyX=Wire.read()<<8|Wire.read();  // 0x43 (GYRO_XOUT_H) & 0x44 (GYRO_XOUT_L)
  GyY=Wire.read()<<8|Wire.read();  // 0x45 (GYRO_YOUT_H) & 0x46 (GYRO_YOUT_L)
  GyZ=Wire.read()<<8|Wire.read();  // 0x47 (GYRO_ZOUT_H) & 0x48 (GYRO_ZOUT_L)
  Serial.print(" | GyY = "); Serial.print(GyY);
  Serial.print("\n");
  //Serial.print(" | GyZ = "); Serial.println(GyZ);
  delay(100);
}

出力あり:

 | AcX = 16676
 | AcX = 16628
 | AcX = 16740
 | AcX = 16692
 | AcX = 16660
 | AcX = 16676
 | AcX = 16780
 | AcX = 16684
 | AcX = 16612
 | AcX = 16644
 | AcX = 16588

これで問題ないようです。しかし、私の C++ コードはまったく正しく動作していないようです。ここにあります：

#include "hwlib.hpp"
#include <iomanip>

int main( void ){

 // kill the watchdog
 WDT->WDT_MR = WDT_MR_WDDIS;

 namespace target = hwlib::target;
// int16_t zaxis, yaxis;
 byte adress = 0x68;

 auto scl = target::pin_oc{ target::pins::scl };
 auto sda = target::pin_oc{ target::pins::sda };

 auto i2c_bus = hwlib::i2c_bus_bit_banged_scl_sda{ scl,sda };


 for(;;){
    byte data[8] = {0x3B};
    i2c_bus.write(adress, data, 1);
    i2c_bus.read(adress, data, 8);
    hwlib::cout  << (int16_t)data[0] << (int16_t)data[1]  << (int16_t)data[2]<< (int16_t)data[3] << (int16_t)data[4] << (int16_t)data[5] << (int16_t)data[6] << (int16_t)data[7] << "\n";
    hwlib::wait_ms(500);
 }
}

hwlib って何？と思っている方へ、学校が提供するライブラリです。hwlib の read メソッドと write メソッドが表示されます。

  void write( fast_byte a, const byte data[], fast_byte n ) override {
       write_start();
       write_byte( a << 1 );
       for( fast_byte i = 0; i < n; i++ ){
          read_ack();
          write_byte( data[ i ] );
      }               
       read_ack();
       write_stop();      
    }

    //
    void read( fast_byte a, byte data[], fast_byte n ) override {
       write_start();
       write_byte( ( a << 1 ) | 0x01 );    
       read_ack();
       for( fast_byte i = 0; i < n; i++ ){
          if( i > 0 ){
             write_ack();
          }   
          data[ i ] = read_byte();
       }               
       write_stop();      
    }

これで、関数で送信したバイト配列にデータが書き込まれるようです。それで、データを取得し、hwlib::cout で画面に表示します。通常の std::cout と同じように機能しますが、先生はそれを使用するように言いました。

出力：

651601120216235240
65522552160248235192
65200120184235240
642280321100235240
64244010812423616
650255208132235224
654004018235224
641320280208235224
654255236102360
65480480200235224

私はこのプロジェクトを失敗することはできないので、私はそれを理解しようとし続けますが、誰かが答えを持っていて、彼らが私が何を間違っているのか、そして私がそれをどのようにすべきかを教えてくれれば、文字通り私の年になります.

前もって感謝します！

4

1 に答える 1