Практика: Считывание угла поворота вала двигателя

Для работы с датчиком AS5600 вам понадобится скачать библиотеку Seeed_Arduino_AS5600. Там также имеется несколько рабочих примеров, в которых вам необходимо только подключить заголовочный файл VBCoreG4_arduino_system.h и указать пины SDA и SCL, используя функции setSDA и setSCL из Wire.h. Напомним, что пинами SDA и SCL являются PB_7_ALT1 и PC6. Или же можно просто воспользоваться их именами pinSDA и pinSCL, определенными в библиотеке. Ниже приведен код программы, читающей угол по датчику AS5600

#include <VBCoreG4_arduino_system.h>
#include <Wire.h>
#include <AS5600.h>

#define pinSDA PB_7_ALT1
#define pinSCL PC6

AMS_5600 sensor;

void setup() {
  Wire.setSDA(pinSDA);
  Wire.setSCL(pinSCL);
  Wire.begin();

  Serial.begin(115200);

  Serial.println(">>>>>>>>>>>>>>>>>>>>>>>>>>> ");
  if(sensor.detectMagnet() == 0 ){
    while(1){
        if(sensor.detectMagnet() == 1 ){
            Serial.print("Current Magnitude: ");
            Serial.println(sensor.getMagnitude());
            break;
        }
        else{
            Serial.println("Can not detect magnet");
        }
        delay(1000);
    }
  } 
}

void loop() {
  Serial.println(sensor.getRawAngle());
  delay(1);
}

Last updated