fcu_motor_test.cpp

Go to the documentation of this file.

#include <FlightController.hpp>

int main(int argc, char *argv[]) {
    const std::string device = (argc>1) ? std::string(argv[1]) : "/dev/ttyUSB0";
    const uint baudrate = (argc>2) ? std::stoul(argv[2]) : 115200;

    fcu::FlightController fcu(device, baudrate);
    fcu.initialise();

    // spin motors 1 to 4
    fcu.setMotors({1100,1100,1100,1100,0,0,0,0});

    std::this_thread::sleep_for(std::chrono::seconds(1));

    // stop motors
    fcu.setMotors({1000,1000,1000,1000,1000,1000,1000,1000});
}