Odrive CPP SDK

This is the simplest C++ implementation of ODrive communication methods possible.

Much of the USB packet encoding / decoding is inspired by https://github.com/tokol0sh/Odrive_USB

It requires USB native and UART native protocol flashed on the odrive in your tup.config, like such:

CONFIG_BOARD_VERSION=v3.4-24V
CONFIG_USB_PROTOCOL=native
CONFIG_UART_PROTOCOL=native
CONFIG_STEP_DIR=n

If you'd like to use the legacy ascii protocol, there is a legacy implementation of this SDK at https://github.com/moorage/odrive_cpp_sdk/tree/legacy-ascii-protocol

The simplest possible c++ program to run this sdk, as an example (assuming 2 motors), is:

#include <iostream>
#include "odrive_cpp_sdk/odrive_cpp_sdk.h"

int main(int argc, const char * argv[]) {
    std::string odrive_serial_numbers[1] = {"53202722976285"};
    std::string odrive_serial_numbers_map[2] = {"53202722976285","53202722976285"};
    int16_t zeroeth_radian_in_encoder_ticks_[2] = { -200, 0 };

    bool odrive_position_per_motor[2] = {false, true};
    bool motor_relative_to_prior_motor[2] = {false, false};
    // odrive_encoder_ticks_per_radian_per_motor lets us account for any gear reductions...
    float odrive_encoder_ticks_per_radian_per_motor[2] = { 57.2958 * (2048 * 4) / 360.0, 57.2958 * (2048 * 4) / 360.0 };
    odrive::CppSdk odrive_cpp_sdk(
        odrive_serial_numbers,
        1,
        odrive_serial_numbers_map,
        odrive_position_per_motor,
        odrive_encoder_ticks_per_radian_per_motor,
        motor_relative_to_prior_motor,
        2
    );
    std::cout << "odrive_cpp_sdk constructed" << std::endl;

    odrive_cpp_sdk.setZeroethRadianInEncoderTicks(zeroeth_radian_in_encoder_ticks_);

    int result = odrive_cpp_sdk.init();
    std::cout << "odrive_cpp_sdk.init got: " << result << std::endl;

    if (result == ODRIVE_SDK_ODRIVE_WITH_SERIAL_NUMBER_NOT_FOUND) {
        std::cout << "odrive_cpp_sdk.init :: ODRIVE_SDK_ODRIVE_WITH_SERIAL_NUMBER_NOT_FOUND" << std::endl;
        return EXIT_FAILURE;
    }

    uint8_t odrive_motor_current_errors[2] = {0};
    result = odrive_cpp_sdk.checkErrors(odrive_motor_current_errors);
    std::cout << "odrive_cpp_sdk.checkErrors got result:" << result << " and value: [" << std::to_string(odrive_motor_current_errors[0]) << "," << std::to_string(odrive_motor_current_errors[1]) << "]" << std::endl;

    double odrive_motor_current_positions[2] = {0};
    result = odrive_cpp_sdk.readCurrentMotorPositions(odrive_motor_current_positions);
    std::cout << "odrive_cpp_sdk.readCurrentMotorPositions got result:" << result << " and value: [" << std::to_string(odrive_motor_current_positions[0]) << "," << std::to_string(odrive_motor_current_positions[1]) << "]" << std::endl;

    double odrive_motor_cmd_positions[2] = { 3.14159 / 2.0, 3.14159 / 2.0 };
    result = odrive_cpp_sdk.setGoalMotorPositions(odrive_motor_cmd_positions);
    std::cout << "odrive_cpp_sdk.setGoalMotorPositions got result:" << result << std::endl;

    odrive_motor_current_errors[0] = 0;
    odrive_motor_current_errors[1] = 0;
    result = odrive_cpp_sdk.checkErrors(odrive_motor_current_errors);
    std::cout << "odrive_cpp_sdk.checkErrors got result:" << result << " and value: [" << std::to_string(odrive_motor_current_errors[0]) << "," << std::to_string(odrive_motor_current_errors[1]) << "]" << std::endl;

    odrive_motor_current_positions[0] = 0;
    odrive_motor_current_positions[1] = 0;
    result = odrive_cpp_sdk.readCurrentMotorPositions(odrive_motor_current_positions);
    std::cout << "odrive_cpp_sdk.readCurrentMotorPositions got result:" << result << " and value: [" << std::to_string(odrive_motor_current_positions[0]) << "," << std::to_string(odrive_motor_current_positions[1]) << "]" << std::endl;
}