ST-MCSDKでPMSMモータを動かす

はじめに

NUCLEO STM32F446REとIHM07M1の組み合わせに、ST MCSDK(ソフトウェア)を組み込んで、ドローンに使用可能なA2208-1100KVモータを動かした。FOCに手入れなくても動作可能になった。確認環境、確認手順を以下にメモしておく。中間生成物のモータプロファイルとワークベンチに、結果物のSTM32CubeIDEプロジェクトを含めるリポジトリをGithubに公開済み。

確認環境

NUCLEO STM32F446RE
X-NUCLEO-IHM07M1
A2208-1100KV SM-PMSM Motor
DC Power Output 14.8V
X-CUBE-MCSDK_5.4.7(Motor profiler & Motor workbench含む)
stm32cubemx-win_v6-3-0
stm32cubeide_1.14.0_19471_20231121_1200_x86_64.
Windows 11

※何回かの試行錯誤から、MCSDK_5.4.7と、stm32cubemx-win_v6-3-0の組み合わせではエラーなく行けると確認された。

確認手順

以下、Motor Profiler→Workbench→STM32CubeIDE→WorkbenchMonitorの順でメモしていく。

Motor Profiler

12極=6ペア、3セル=14.8V、1100KV * 14.8V=16280RPM、永久磁石は回転子表面実装=SM-PMSMとして入力して、一度モータを馳せて、測定したモータプロファイルを書き出す。入力したMAX SPEEDまでモータを回転させるので、机に固定することに注意すること。

motor-profiler
motor-profiler

Workbench

Workbenchを立ち上げて、制御ボード、モータドライバ、モータプロファイルとともに、Workbenchプロジェクトを書き出す。

create-workbench
create-workbench

save-workbench
save-workbench

project-generation
project-generation

STM32CubeIDE

Workbenchプロジェクトを読み込んで、コンパイルして制御ボードに書き込む。

stm32cubeide-import-workbench
stm32cubeide-import-workbench

Workbench Monitor

Workbench Monitorを立ち上げて、Start/Stop Motorでモータを制御する。

workbench-monitor
workbench-monitor

リポジトリ

https://github.com/soarbear/stm32f446-ihm07m1に公開済み。

参考資料

STM32向けモータ制御ソフトウェア開発キット(MCSDK)
X-NUCLEO-IHM07M1
Three-phase brushless DC motor driver expansion board based on L6230 for STM32 Nucleo

NUCLEO-F446RE
STM32 Nucleo-64 development board with STM32F446RE MCU, supports Arduino and ST morpho connectivity

1+

ロボット・ドローン部品お探しなら
ROBOT翔・電子部品ストア

stm32h750のdacとtimerでsine波を作る

はじめに

いよいよSTM32ファミリーのハイクラスに属する、Cortex-M7コアをもつ、stm32h750(クロック周波数480MHz)を新製品に組み込もうと、早速stm32h750の開発ボードでSine波を作ってみよう。今回はSine波のサンプリングデータを1周期当たり100データに、DACでアナログ波に、トリガをTimer6に、サンプリングデータをDMA転送に指定して、Sine波の周波数は、タイマクロック周波数240MHz / タイマのリロード最大カウンタ数(239+1) / Sine波1周期当たりタイマリロード数100 = 10KHzにしよう。

確認環境

・Windows 10 / STM32CubeIDE
・stm32h750 開発ボード
・ST-LINK V2 プログラマ/デバッガ
・オシロスコープ

STM32H750プログラマSTlLINK_V2を使用
STM32H750プログラマSTlLINK_V2を使用

パタメータ配置

RCC、Clock、DAC、Timer、DMA、Serial wireの順でパラメータ配置を行って、STM32CubeIDEにソースコード生成しよう。

Target MCU

TargetをSTM32H750VBに指定する。

STM32H750VBをターゲットとして指定
STM32H750VBをターゲットとして指定

RCC

RCCを外部HSEクリスタルに指定する。

stm32h750のRCC配置
stm32h750のRCC配置

Clock

HSEを25MHzオンボードに指定して、Timerクロックを240MHzにする。Timerクロックは他の値にしてもありうる。

stm32h750のクロック配置
stm32h750のクロック配置

DAC

DACのOutput2に指定する。

STM32H750のDACをOutput2に指定する
STM32H750のDACをOutput2に指定する

Timer

Timer6に指定する。

STM32H750のTimer6に指定
STM32H750のTimer6に指定

DMA

MCUの負担を軽減して、DMA転送方式に指定する。

STM32H750のDMAに指定
STM32H750のDMAに指定

Serial wire

プログラマ&デバッガをSWD(ST-LINK)に指定する。

STM32H750のデバッガをSerial wireに
STM32H750のデバッガをSerial wireに

ソースコード

Generate codeして、main.cへ以下ソースを追加する。

/* USER CODE BEGIN 0 */
uint16_t data[100];
void sine_wave(void) {
	for (uint16_t i = 0; i < 100; i++) {
		data[i] = (uint16_t)(2000 * sin(i * 2 * 3.14159 / 100) + 2000);
	}
}
/* USER CODE END 0 */

int main() {
...
/* USER CODE BEGIN 2 */
sine_wave();
HAL_TIM_Base_Start(&htim6);
HAL_DAC_Start_DMA(&hdac1, DAC_CHANNEL_2, (uint32_t *)data, 100, DAC_ALIGN_12B_R);
/* USER CODE END 2 */
...
}

出力確認

BUILD & RUN、Sine波は予想通り、周期10KHzでPA5から出力されていることを確認済み。

STM32h750の出力Sine波を確認する
STM32h750の出力Sine波を確認する

プロジェクト

https://github.com/soarbear/stm32h750_dac_timer_sine_wave に公開済み。

2+

ロボット・ドローン部品お探しなら
ROBOT翔・電子部品ストア

ACMEによる、新規サブドメインのSSL対応

はじめに

数年前から、ドメインのSSL対応にGithub公開リソースのACMEを利用してきた。新規サブドメインの開設に当たって、以前と同様にACMEを利用するつもりで、ACMEの証明書サーバはLets encryptからZeroSSLへ移行済みなど変更があったので、作業手順をメモしておく。

準備

$su root

#cat /etc/redhat-release
CentOS release 6.8 (Final)

#acme.sh --upgrade

#acme.sh --version
https://github.com/acmesh-official/acme.sh
v3.0.7

DNSゾン追加

サーバプロバイダの管理画面またはパネルから、サブドメインに必要なDNSゾンの追加を行うことができる。これでサブドメインとIPと紐づける。追加手順はサーバプロバイダのほうへ確認するので、ここでは詳細を省く。

Apache対応

サブドメイン追加

vhost.confを開く

#nano /etc/httpd/conf.d/vhost.conf

vhost.confへ内容追加。

<VirtualHost *:80>
ServerName new-sub.example.com
ServerAlias www.new-sub.example.com
Redirect / https://new-sub.example.com/
</VirtualHost>
<VirtualHost *:443>
ServerAdmin mai@example.com
DocumentRoot /var/www/html/new-sub.exmaple.com
ServerName new-sub.exmaple.com
ServerAlias www.new-sub.example.com
# ここにあとで追加内容ある
ErrorLog "/var/log/httpd/new_error_log"
CustomLog "/var/log/httpd/new_access_log" combined
</VirtualHost>

Apache再起動

#servcie http restart

ACME対応

証明書作成

#acme.sh --issue -d new-sub.example.com --apache

証明書コピー

コピー先を指定しておく。

#acme.sh --install-cert -d example.com \
--cert-file      /root/apache/new-sub.example.com/cert.pem  \
--key-file       /root/apache/new-sub.example.com/key.pem  \
--fullchain-file /root/apache/new-sub.example.com/fullchain.pem \
--reloadcmd     "service httpd restart"

証明書確認

#acme.sh --info -d new-sub.example.com

vhost.confに内容追加

<VirtualHost *:80>
ServerName new-sub.example.com
ServerAlias www.new-sub.example.com
Redirect / https://new-sub.example.com/
</VirtualHost>
<VirtualHost *:443>
ServerAdmin mail@example.com
DocumentRoot /var/www/html/new-sub.example.com
ServerName new-sub.example.com
ServerAlias www.new-sub.example.com
SSLEngine on
SSLCertificateFile /root/apache/new-sub.example.com/cert.pem
SSLCertificateKeyFile /root/apache/new-sub.example.com/key.pem
SSLCertificateChainFile /root/apache/new-sub.example.com/fullchain.pem
<Directory "/var/www/html/new-sub.example.com">
AllowOverride All
</Directory>
ErrorLog "/var/log/httpd/new_error_log"
CustomLog "/var/log/httpd/new_access_log" combined
</VirtualHost>

Apache再起動

#servcie http restart

証明書自動更新

#EDITOR=nano crontab -e
56 * * * * "/root/.acme.sh"/acme.sh --cron --home "/root/.acme.sh" > /dev/null

参考情報

https://github.com/acmesh-official/acme.sh

0

ロボット・ドローン部品お探しなら
ROBOT翔・電子部品ストア

エンコーダ付きDCモータPID制御の実験-haya_imu応用例

はじめに

DCモータに対する、PID制御とは、制御量(本文では減速機出力シャフトの回転速度、角速度といい)と、目標値(本文ではターゲット回転速度、目標角速度といい)の差分(本文ではエラーといい)を無くすための操作量(PWMパルス出力)に関わる、P(比例)制御、I(積分)制御、D(微分)制御をかけるとのこと。ロータリエンコーダは回転速度を安易に計算可能な要素(A相/B相パルス)を提供する、常用デバイスとして利用される。本実験の趣旨としては、回転速度の計算ベースとなる、エンコーダのA/B相パルスは正しく計測されたかどうか、またPID制御の精度、確度を評価するに当たって、他のデバイス、本実験ではhaya_imu(ICM-42688、MMC5983MA内蔵)を活用して評価すること。

実験環境

●12V入力DCブラシモータ
●12V出力DC電源(Motor Shieldへ給電)
●磁気式エンコーダ
●Arduino Leonardo正規品基板
●Adafruit Motor Shield v1.2互換基板(ライブラリ修正あり、Timer3A/D5-pin/PWM周波数を4KHzへ変更済み)
●9軸センサhaya_imu v3.2
●Raspberry Pi 3 Model-B(ROS Slave、Unbuntu20.04/Noetic、haya_imuへ接続)
●5V出力DC電源(Raspberry Piへ給電)
●Lenovo L560(ROS Master、Unbuntu18.04/Melodic、Arduino Leonardoへ接続)

haya_imu用いてDCモータPID制御評価環境
haya_imu用いてDCモータPID制御評価環境

開発要素

ROSパッケージ

以下ROSパッケージ、ROSカスタムメッセージまたはライブラリをインストールして、catkin_makeしておく。

rosserial
haya_motor_ros
haya_imu_ros
ros_lib by rosserail_arduino with Arduino IDE
Adafruit-Motor-Shield-library-leonardo
arduino_node(ino) on Leonardo with Arduino IDE 

ROSノード

/arduino_haya_motor
/haya_imu_node
/haya_motor_node
/rosout
/rqt_plot

ROSトピック

/arduino_msg
/diagnostics
/haya_angular_velocity_z
/imu_data
/pid_params
/rosout
/rosout_agg

ROSカスタムメッセージ

haya_imu_ros/ImuData
haya_motor_ros/ArduinoMsgs
haya_motor_ros/PidMsgs

ROSノードの相互作用状況

エンコーダ付きDCモータPID制御の実験-ROS node & ROS topic
エンコーダ付きDCモータPID制御の実験-ROS node & ROS topic

Arduinoノード

エンコーダA相パルス割込みハンドラ

  if (digitalRead(ENCODER_A) != digitalRead(ENCODER_B)) {
    current_counter++;
  }
  else {
    current_counter--;
  }

エンコーダB相パルス割込みハンドラ

  if (digitalRead(ENCODER_A) == digitalRead(ENCODER_B)) {
    current_counter++;
  }
  else {
    current_counter--;
  }

エンコーダカウンタによる回転速度

// Run the PID loop at 100 times per second
#define PID_RATE_HZ 10 // 10Hz
// Convert the rate into an interval
#define PID_INTERVAL_MS (1000 / PID_RATE_HZ) // 10ms
#define PID_INTERVAL_S (float)(1.0 / PID_RATE_HZ) // 0.1s
#define PPR 12 // Encoder pulse / round
#define COUNTER_FACTOR 4 // 1*encoder-pulse = 4*counter
#define REDUCTION_RATIO 100 // Gear reduction ratio
#define CPR (PPR * COUNTER_FACTOR * REDUCTION_RATIO) // Counters of encoder / round
current_velocity = (current_counter - previous_counter) * 360.0 / (CPR * PID_INTERVAL_S);

PID係数

本実験環境で何回も実験を繰り返して、納得いくPID係数Kp、Ki、Kdを決めておく。

PID操作量

●Position法

  error = target_velocity - current_velocity;
  integral += error * PID_INTERVAL_S;
  differential = (error - previous_error) / PID_INTERVAL_S;
  previous_error = error;
  pwm = (int32_t)(Kp * error + Ki * integral + Kd * differential);

●Increment法

  error = target_velocity - current_velocity;
  proportion = Kp * (error - previous_error);
  integral = Ki * error * PID_INTERVAL_S;
  differential = Kd * (error - 2 * previous_error + previous_error2) / PID_INTERVAL_S;
  pwm += (int32_t)(proportion + integral + differential);
  previous_error2 = previous_error;
  previous_error = error;

実験手順

Run roscore

Run roscore@ROS Master

roscore

Launch haya_imu_node

Launch haya_imu_node@ROS Slave

roslaunch haya_imu_ros haya_imu.launch

Launch haya_motor_node

Launch haya_motor_node@ROS Master

roslaunch haya_motor_ros haya_motor.launch

結果確認

PID制御の目標値、制御量

以下のデータを表示させて、エンコーダ、IMUからのカウンタによる回転速度を確かめて、PID係数Kp、Ki、Kdを決めてまた、エンコーダまたは、PID制御を評価する。PWM周波数をデフォルトの490Hzから4KHzに変更することで回転速度の分散は小さくなっている。これは490Hzより4KHz周波数のほうはモータにブレーキをかけずにPWM波形は滑らかになって果たしてモータ出力シャフトの回転速度も滑らかになったわけである。

/haya_angular_velocity_z 
/pid_params/target_velocity
/arduino_msg/current_velocity
PID制御の目標値、エンコーダによる回転速度、haya_imu測った回転速度曲線
PID制御の目標値、エンコーダによる回転速度、haya_imu測った回転速度曲線

haya_imuで測った回転速度が、エンコーダによる回転速度より分散が大きくなって、これは測定法および測定ポジションは違って、またモータシャフトによる振動や、慣性力に由来するものと考えられる。

PID制御の目標値、制御量、操作量

PID制御の目標値、PWM操作量、エンコーダによる回転速度

PID制御の目標値、PWM操作量、エンコーダによる回転速度
PID制御の目標値、PWM操作量、エンコーダによる回転速度

PID制御の操作量PWM波形

オシロスコープは測った操作量PWMの波形、モータコイルに起因する逆起電力による、コイルサージは約-14Vあったと、モータシールド実装モータドライバL293Dにコイルサージ(逆起電流)を流すダイオードが効いていると考えられる。ないと一瞬-12Vの数十倍~-1千万V(無限大)に達する可能性ある。これで回路で繋がっているデジタルICを一発でぶち壊すことになる。

PID制御の操作量PWM波形
PID制御の操作量PWM波形

エンコーダ出力パルス波形

約1/10の確率でノイズに起因するスパイクが起きるらしいので、MCUにノイズフィルタ実装の入力PINは望ましい。

エンコーダパルス波形ノイズスパイクあり
エンコーダパルス波形ノイズスパイクあり

リポジトリ

haya_motor_ros、arduino_node、修正ありMotor Shieldライブラリ含むリポジトリは、https://github.com/soarbear/haya_motor_ros に公開済み(BSD 3-Clause License)

最後に

IMUはモータシャフトでなくロボット本体に装着した場合、エンコーダのみならずLidar、カメラ、GPS他のセンサーとフュージョンする場合多い。

参考記事

ロータリエンコーダによる速度計算
9軸センサーICM-42688+MMC5983 6軸&9軸回転ベクトル&3軸オイラー角 MAX1000Hz同時出力 ROS/ROS2対応 USB接続

0

ロボット・ドローン部品お探しなら
ROBOT翔・電子部品ストア

エンコーダ付きDCモータPID制御の実験-hayate_imu応用例

はじめに

DCモータに対する、PID制御とは、制御量(本文では出力減速機シャフトの回転速度、角速度といい)と、目標値(本文ではターゲット回転速度、目標角速度といい)の差分(本文ではエラーといい)を無くすための操作量(PWMパルス出力)に関わる、P(比例)制御、I(積分)制御、D(微分)制御をかけるとのこと。ロータリエンコーダは回転速度を安易に計算可能な要素(A相/B相パルス)を提供する、常用デバイスとして利用される。本実験の趣旨としては、回転速度の計算ベースとなる、エンコーダのA/B相パルスは正しく計測されたかどうか、またPID制御の精度、確度を評価するに当たって、他のデバイス、本実験ではhayate_imu(ICM-20948内蔵)を活用して評価すること。

実験環境

●12V入力DCブラシモータ
●12V出力DC電源(Motor Shieldへ給電)
●磁気式エンコーダ
●Arduino Leonardo正規品基板
●Adafruit Motor Shield v1.2互換基板(ライブラリ修正あり、Timer3A/D5-pin/PWM周波数を4KHzへ変更済み)
●9軸センサhayate_imu v2.4
●Raspberry Pi 3 Model-B(ROS Slave、Unbuntu20.04/Noetic、hayate_imuへ接続)
●5V出力DC電源(Raspberry Piへ給電)
●Lenovo L560(ROS Master、Unbuntu18.04/Melodic、Arduino Leonardoへ接続)

hayate_imu用いてDCモータPID制御評価環境
hayate_imu用いてDCモータPID制御評価環境

開発要素

ROSパッケージ

以下ROSパッケージ、ROSカスタムメッセージまたはライブラリをインストールして、catkin_makeしておく。

rosserial
hayate_motor_ros
hayate_imu_ros
ros_lib by rosserail_arduino with Arduino IDE
Adafruit-Motor-Shield-library-leonardo
arduino_node(ino) on Leonardo with Arduino IDE 

ROSノード

/arduino_node
/hayate_imu_ros
/hayate_motor_node
/rosout
/rqt_plot

ROSトピック

/arduino_msg
/diagnostics
/hayate_angular_velocity_z
/imu_cali
/imu_data
/imu_demo
/pid_params
/rosout
/rosout_agg

ROSカスタムメッセージ

hayate_imu_ros/ImuCali
hayate_imu_ros/ImuData
hayate_motor_ros/ArduinoMsgs
hayate_motor_ros/PidMsgs

ROSノードの相互作用状況

エンコーダ付きDCモータPID制御の実験-ROS node & ROS topic
エンコーダ付きDCモータPID制御の実験-ROS node & ROS topic

Arduinoノード

エンコーダA相パルス割込みハンドラ

  if (digitalRead(ENCODER_A) != digitalRead(ENCODER_B)) {
    current_counter++;
  }
  else {
    current_counter--;
  }

エンコーダB相パルス割込みハンドラ

  if (digitalRead(ENCODER_A) == digitalRead(ENCODER_B)) {
    current_counter++;
  }
  else {
    current_counter--;
  }

エンコーダカウンタによる回転速度

// Run the PID loop at 100 times per second
#define PID_RATE_HZ 10 // 10Hz
// Convert the rate into an interval
#define PID_INTERVAL_MS (1000 / PID_RATE_HZ) // 10ms
#define PID_INTERVAL_S (float)(1.0 / PID_RATE_HZ) // 0.1s
#define PPR 12 // Encoder pulse / round
#define COUNTER_FACTOR 4 // 1*encoder-pulse = 4*counter
#define REDUCTION_RATIO 100 // Gear reduction ratio
#define CPR (PPR * COUNTER_FACTOR * REDUCTION_RATIO) // Counters of encoder / round
current_velocity = (current_counter - previous_counter) * 360.0 / (CPR * PID_INTERVAL_S);

PID係数

本実験環境で何回も実験を繰り返して、納得いくPID係数Kp、Ki、Kdを決めておく。

PID操作量

●Position法

  error = target_velocity - current_velocity;
  integral += error * PID_INTERVAL_S;
  differential = (error - previous_error) / PID_INTERVAL_S;
  previous_error = error;
  pwm = (int32_t)(Kp * error + Ki * integral + Kd * differential);

●Increment法

  error = target_velocity - current_velocity;
  proportion = Kp * (error - previous_error);
  integral = Ki * error * PID_INTERVAL_S;
  differential = Kd * (error - 2 * previous_error + previous_error2) / PID_INTERVAL_S;
  pwm += (int32_t)(proportion + integral + differential);
  previous_error2 = previous_error;
  previous_error = error;

実験手順

Run roscore

Run roscore@ROS Master

roslaunch haya_imu_ros haya_imu.launch

Launch hayate_imu_node

Launch hayate_imu_node@ROS Slave

roslaunch hayate_imu_ros hayate_imu.launch

Launch hayate_motor_node

Launch hayate_motor_node@ROS Master

roslaunch hayate_motor_ros hayate_motor.launch
rqt_graph

結果確認

PID制御の目標値、制御量

以下のデータを表示させて、エンコーダ、IMUからのカウンタによる回転速度を確かめて、PID係数Kp、Ki、Kdを決めてまた、エンコーダまたは、PID制御を評価する。PWM周波数をデフォルトの490Hzから4KHzに変更することで回転速度の分散は小さくなっている。これは490Hzより4KHz周波数のほうはモータにブレーキをかけずにPWM波形は滑らかになって果たしてモータ出力シャフトの回転速度も滑らかになったわけである。

/hayate_angular_velocity_z 
/pid_params/target_velocity
/arduino_msg/current_velocity
PID制御の目標値、エンコーダによる回転速度、hayate_imu測った回転速度曲線
PID制御の目標値、エンコーダによる回転速度、hayate_imu測った回転速度曲線

hayate_imuで測った回転速度が、エンコーダによる回転速度より分散が大きくなって、これは測定法および測定ポジションは違って、またモータシャフトによる振動や、慣性力に由来するものと考えられる。

PID制御の目標値、制御量、操作量

PID制御の目標値、PWM操作量、エンコーダによる回転速度

PID制御の目標値、PWM操作量、エンコーダによる回転速度
PID制御の目標値、PWM操作量、エンコーダによる回転速度

PID制御の操作量PWM波形

オシロスコープは測った操作量PWMの波形、モータコイルに起因する逆起電力による、コイルサージは約-14Vあったと、モータシールド実装モータドライバL293Dにコイルサージ(逆起電流)を流すダイオードが効いていると考えられる。ないと一瞬-12Vの数十倍~-1千万V(無限大)に達する可能性ある。これで回路で繋がっているデジタルICを一発でぶち壊すことになる。

PID制御の操作量PWM波形
PID制御の操作量PWM波形

エンコーダ出力パルス波形

約1/10の確率でノイズに起因するスパイクが起きるらしいので、MCUにノイズフィルタ実装の入力PINは望ましい。

エンコーダパルス波形ノイズスパイクあり
エンコーダパルス波形ノイズスパイクあり

リポジトリ

hayate_motor_ros、arduino_node、修正ありMotor Shieldライブラリ含むリポジトリは、https://github.com/soarbear/hayate_motor_ros に公開済み(BSD 3-Clause License)

最後に

IMUはモータシャフトでなくロボット本体に装着した場合、エンコーダのみならずLidar、カメラ、GPS他のセンサーとフュージョンする場合多い。

参考記事

ロータリエンコーダによる速度計算
9軸IMUセンサ 6軸/9軸フュージョン 低遅延 USB出力 補正済み ROS対応

0

ロボット・ドローン部品お探しなら
ROBOT翔・電子部品ストア