Arduino Simple Field Oriented Control (FOC) library

We live in very exciting times 😃! BLDC motors are entering the hobby community more and more and many great projects have already emerged leveraging their far superior dynamics and power capabilities. BLDC motors have numerous advantages over regular DC motors but they have one big disadvantage, the complexity of control. Even though it has become relatively easy to design and manufacture PCBs and create our own hardware solutions for driving BLDC motors the proper low-cost solutions are yet to come. One of the reasons for this is the apparent complexity of writing the BLDC driving algorithms, Field oriented control (FOC) being an example of one of the most efficient ones. The solutions that can be found on-line are almost exclusively very specific for certain hardware configuration and the microcontroller architecture used. Additionally, most of the efforts at this moment are still channeled towards the high-power applications of the BLDC motors and proper low-cost and low-power FOC supporting boards are very hard to find today and even may not exist.
Therefore this is an attempt to:

🎯 Demystify FOC algorithm and make a robust but simple Arduino library: Arduino SimpleFOClibrary
- Support as many motor + sensor + driver + mcu combinations out there
🎯 Develop a modular FOC supporting BLDC driver boards:
- Low-power gimbal driver (<5Amps) : Arduino SimpleFOCShield.
- NEW 📢: Medium-power BLDC driver (<30Amps): Arduino SimpleFOCPowerShield .
- See also @byDagor's fully-integrated ESP32 based board: Dagor Brushless Controller

Release notes: SimpleFOClibrary v2.2

Sensor floating point error bugfux #83

Support for portenta h7 board

Support for arduino leonardo #108

Support for esp8266

Low side current sensing support for esp32

Restructured the generic code and simplified adding new mcus

Awesome 😃 Low side current sening support for B_G431B_ESC1 by @sDessens: PR #73

The release will be mande as soon as the docs are ready

Arduino SimpleFOClibrary v2.1

This video demonstrates the SimpleFOClibrary basic usage, electronic connections and shows its capabilities.

Features

Arduino compatible:
- Arduino library code
- Arduino Library Manager integration
Open-Source: Full code and documentation available on github
Easy to setup and configure:
- Easy hardware configuration
- Easy tuning the control loops
Modular:
- Supports as many sensors, BLDC motors and driver boards as possible
- Supports multiple MCU architectures:
  - Arduino: UNO, MEGA, any board with ATMega328 chips
  - STM32 boards: Nucleo, Bluepill ...
  - ESP32
  - Teensy boards
Plug & play: Arduino SimpleFOCShield

Arduino SimpleFOCShield v2.0.3

Features

Plug & play: In combination with Arduino SimpleFOClibrary - github
Low-cost: Price of €15 - Check the pricing
In-line current sensing: Up to 3Amps/5Amps bidirectional
- configurable: 3.3Amps - 3.3V adc, 5Amps - 5V adc
Integrated 8V regulator:
- Enable/disable by soldering pads
Max power 120W - max current 5A, power-supply 12-24V
- Designed for Gimbal motors with the internal resistance >10 Ωs.
Stackable: running 2 motors in the same time
Encoder/Hall sensors interface: Integrated 3.3kΩ pullups (configurable)
I2C interface: Integrated 4.7kΩ pullups (configurable)
Configurable pinout: Hardware configuration - soldering connections
Arduino headers: Arduino UNO, Arduino MEGA, STM32 Nucleo boards...
Open Source: Fully available fabrication files - how to make it yourself

Getting Started

Depending on if you want to use this library as the plug and play Arduino library or you want to get insight in the algorithm and make changes there are two ways to install this code.

Full library installation Docs
Minimal project builder Docs

Arduino SimpleFOClibrary installation to Arduino IDE

Arduino Library Manager

The simplest way to get hold of the library is directly by using Arduino IDE and its integrated Library Manager.

Open Arduino IDE and start Arduino Library Manager by clicking: Tools > Manage Libraries....
Search for Simple FOC library and install the latest version.
Reopen Arduino IDE and you should have the library examples in File > Examples > Simple FOC.

Using Github website

Go to the github repository
Click first on Clone or Download > Download ZIP.
Unzip it and place it in Arduino Libraries folder. Windows: Documents > Arduino > libraries.
Reopen Arduino IDE and you should have the library examples in File > Examples > Simple FOC.

Using terminal

Open terminal and run

cd #Arduino libraries folder
git clone https://github.com/simplefoc/Arduino-FOC.git

Reopen Arduino IDE and you should have the library examples in File > Examples > Simple FOC.

SimpleFOClibrary minimal project builder

For those willing to experiment and to modify the code I suggest using the minimal project builder minimal branch.

This code is completely independent and you can run it as any other Arduino Sketch without the need for any libraries.

All you need to do is:

Go to minimal branch
Follow the tutorial in the README file and choose only the library files that are necessary for your application.

Arduino code example

This is a simple Arduino code example implementing the velocity control program of a BLDC motor with encoder.

NOTE: This program uses all the default control parameters.

#include <SimpleFOC.h>

//  BLDCMotor( pole_pairs )
BLDCMotor motor = BLDCMotor(11);
//  BLDCDriver( pin_pwmA, pin_pwmB, pin_pwmC, enable (optional) )
BLDCDriver3PWM driver = BLDCDriver3PWM(9, 10, 11, 8);
//  Encoder(pin_A, pin_B, CPR)
Encoder encoder = Encoder(2, 3, 2048);
// channel A and B callbacks
void doA(){encoder.handleA();}
void doB(){encoder.handleB();}


void setup() {  
  // initialize encoder hardware
  encoder.init();
  // hardware interrupt enable
  encoder.enableInterrupts(doA, doB);
  // link the motor to the sensor
  motor.linkSensor(&encoder);
  
  // power supply voltage [V]
  driver.voltage_power_supply = 12;
  // initialise driver hardware
  driver.init();
  // link driver
  motor.linkDriver(&driver);

  // set control loop type to be used
  motor.controller = MotionControlType::velocity;
  // initialize motor
  motor.init();
  
  // align encoder and start FOC
  motor.initFOC();
}

void loop() {
  // FOC algorithm function
  motor.loopFOC();

  // velocity control loop function
  // setting the target velocity or 2rad/s
  motor.move(2);
}