実験1 四輪駆動・四輪全方向メカナムシャーシの障害物回避

実験の目的：

モーターの PID 制御の応用と、四輪駆動メカナムシャーシの運動学モデリングを理解すること。
超音波測距の原理と組み合わせて、シャーシの障害物回避を実現すること。
STM32 の GPIO 周辺機能ピン を設定する方法を習得すること。
STM32CubeMX で新規プロジェクトを作成し、MDK_ARM プロジェクトファイルを生成できるようになること。
Keil IDE でユーザーコードを追加し、プロジェクトのテストを行えるようになること。

四輪駆動メカナムホイールシャーシの基本運動原理：

四輪駆動の全方向メカナムホイールシャーシは全方向への平行移動が可能で、そのためには各ホイールの回転方向を制御する必要があります。シャーシの移動方向と各ホイールの回転方向の関係は以下のとおりです。


前進	後退

右平行移動	左平行移動

その場で左旋回	その場で右旋回

超音波による距離検出の原理：

超音波センサーは、超音波を利用して距離測定や物体検出を行うデバイスです。その動作原理は主に以下のステップで構成されます。

超音波の送信

送信器：超音波センサーには超音波送信器が内蔵されており、通常は圧電素子が使われています。

信号の発生：送信器は電気信号を受け取ると高周波の音波（通常 20kHz 以上）を発生させ、波動として外部へ伝搬させます。

超音波の伝搬

伝搬媒体：超音波は空気中を約 343 m/s（室温時）の速度で伝搬します。

反射：超音波は障害物（物体の表面など）に当たると反射します。

超音波の受信

受信器：超音波センサーには受信器が内蔵されており、通常これも圧電素子です。

信号の受信：受信器は反射してきた超音波信号を捉え、電気信号に変換します。

距離の計算

時間の測定：センサーは、超音波を送信してから反射信号を受信するまでに要した時間（T）を測定します。

距離の計算：次の式に従って

物体とセンサー間の距離を計算します。ここでの「2」は、信号の伝搬に往路と復路の両方の時間が含まれるためです。

また、速度の単位を cm/マイクロ秒に換算する必要があるため、最終的な距離の式は次のようになります。

D = 344 × 10² × 10⁻⁶ × t/2 = 0.0172t ≈ t/58（t はマイコンが検出した超音波の送信から受信までの時間間隔）

機能要件：

シャーシはデフォルトで前進します。障害物を検出すると後退して平行移動し、その後再び前進を続けます。

ハードウェアの準備：

STM32 メインボード V1.3 × 1、ST-Link ダウンロードケーブル × 1、3S バッテリーボックス × 1、リチウムバッテリー × 3、エンコーダーモーター 30 × 4、エンコーダーモーターケーブル 2.54 × 4

プロトタイプ構成：

実験7 サスペンション付き矩形フレームと四輪駆動全方向メカナムシャーシの構造設計

回路接続：

ハードウェアモジュール

ヒント：ハードウェアおよびソフトウェア環境の設定

UNI-STM32 開発ボード【V1.3】の紹介

UNI-STM32 開発環境の設定【V2.0】

バッテリーおよび電源モジュール使用上の注意（必読）

電子モジュールの紹介

ピンの説明

シャーシのハードウェア	STM32 インターフェース	電子ハードウェア	STM32 インターフェース
エンコーダー付き DC モーター	M3	超音波 J1	PA4：TRIG1　PA8：Echo 1
エンコーダー付き DC モーター	M4	超音波 J2	PA5：TRIG2　PB3：Echo 2
エンコーダー付き DC モーター	M5
エンコーダー付き DC モーター	M6

実機の配線

ピン表に従って配線してください。

ソフトウェア設計：

設計フロー

プロジェクトのダウンロード

ソースコードのリンク：（HumansX サポートより提供）

プログラムコード

コアコード：main.c

/* USER CODE BEGIN Header */
/**
  ******************************************************************************
  * @file           : main.c
  * @brief          : Main program body
  ******************************************************************************
  * @attention
  *
  * Copyright (c) 2025 STMicroelectronics.
  * All rights reserved.
  *
  * This software is licensed under terms that can be found in the LICENSE file
  * in the root directory of this software component.
  * If no LICENSE file comes with this software, it is provided AS-IS.
  *
  ******************************************************************************
  */
/* USER CODE END Header */
/* Includes ------------------------------------------------------------------*/
#include "main.h"
#include "tim.h"
#include "usart.h"
#include "gpio.h"

/* Private includes ----------------------------------------------------------*/
/* USER CODE BEGIN Includes */
#include "led.h"
#include "motor.h"
#include "DWT_time.h"
#include "ultrasonic.h"
#include "stdbool.h"
/* USER CODE END Includes */

/* Private typedef -----------------------------------------------------------*/
/* USER CODE BEGIN PTD */

/* USER CODE END PTD */

/* Private define ------------------------------------------------------------*/
/* USER CODE BEGIN PD */

/* USER CODE END PD */

/* Private macro -------------------------------------------------------------*/
/* USER CODE BEGIN PM */

/* USER CODE END PM */

/* Private variables ---------------------------------------------------------*/

/* USER CODE BEGIN PV */
float ult1_dis = 0.0;    //save ultrasonic1 distance
float ult2_dis = 0.0;    //save ultrasonic2 distance
float vel = 0.1;         //set car speed
float sth_dis1 = 12.0;   //Set ultrasonic1 detection to detect obstacle distance
float sth_dis2 = 12.0;   //Set ultrasonic2 detection to detect obstacle distance
float min_dis  = 2.0;    //Set the minimum distance for ultrasonic detection
uint8_t last_state = 0;  //1:back+right, 2:back+left, 3:stop, 4:forward
uint16_t obstacle_numbers = 0;           //define obstacle numbers
uint16_t ultrasonic_status = 0;
uint16_t ult_sta = 0;

uint16_t get_ult_status(float ult1_distance, float ult2_distance, float ult_distance_min);
bool ult_flag = false;
bool road_flag = false;
/* USER CODE END PV */

/* Private function prototypes -----------------------------------------------*/
void SystemClock_Config(void);
/* USER CODE BEGIN PFP */

/* USER CODE END PFP */

/* Private user code ---------------------------------------------------------*/
/* USER CODE BEGIN 0 */

/* USER CODE END 0 */

/**
  * @brief  The application entry point.
  * @retval int
  */
int main(void)
{

  /* USER CODE BEGIN 1 */

  /* USER CODE END 1 */

  /* MCU Configuration--------------------------------------------------------*/

  /* Reset of all peripherals, Initializes the Flash interface and the Systick. */
  HAL_Init();

  /* USER CODE BEGIN Init */

  /* USER CODE END Init */

  /* Configure the system clock */
  SystemClock_Config();

  /* USER CODE BEGIN SysInit */

  /* USER CODE END SysInit */

  /* Initialize all configured peripherals */
  MX_GPIO_Init();
  MX_USART1_UART_Init();
  MX_TIM8_Init();
  MX_TIM5_Init();
  MX_TIM6_Init();
  MX_TIM1_Init();
  MX_TIM2_Init();
  /* USER CODE BEGIN 2 */
  HAL_Delay(18000);
  Hcsr04Init(&htim1, TIM_CHANNEL_1);      //Ultrasonic1 init
  Hcsr04Start(1);                         //Ultrasonic1 init
  Hcsr04Init(&htim2, TIM_CHANNEL_2);      //Ultrasonic2 init
  Hcsr04Start(2);                         //Ultrasonic2 init

  Motor_Init();                           //motor init
  dwt_init();                             //DWT_start
  enable(&m1);                            //m3 enable
  enable(&m2);                            //m4 enable
  enable(&m3);                            //m5 enable
  enable(&m4);                            //m6 enable

  //If omitted here, the radius defaults to 0.0325
  set_radius(&m1, 0.0475);                //set m3 wheel radius. unit: m
  set_radius(&m2, 0.0475);                //set m4 wheel radius. unit: m
  set_radius(&m3, 0.0475);                //set m5 wheel radius. unit: m
  set_radius(&m4, 0.0475);                //set m6 wheel radius. unit: m

  HAL_TIM_Base_Start_IT(&htim6);          //Base TIM6 start
  ult_flag = true;
  road_flag = false;
  /* USER CODE END 2 */

  /* Infinite loop */
  /* USER CODE BEGIN WHILE */
  while (1)
  {
    /* USER CODE END WHILE */

    /* USER CODE BEGIN 3 */
    if(ult_flag == true){

        ult_sta = get_ult_status(sth_dis1, sth_dis2, min_dis);
        printf("ult_sta: %d\r\n", ult_sta);

        if(ult_sta == 3){
            car_move( 0.0,  0.0,  0.0); HAL_Delay(600);
            ult_flag = false;
            road_flag = true;
            obstacle_numbers = obstacle_numbers + 1;
            led_open(3);
        }
        else{
            car_move( 0.15,  0.0,  0.0);
            HAL_Delay(30);
        }
    }
    ///*
    if(road_flag == true){
        ult_sta = get_ult_status(sth_dis1 + 8, sth_dis2 + 8, min_dis);
        //------------------------------------------------------------road 1
        if(obstacle_numbers == 1){
            if(ult_sta == 4){
                car_move( 0.0,  0.15,  0.0); HAL_Delay(1500);
                led_off(3);
                road_flag = false;
                ult_flag = true;
                car_move( 0.0,  0.0,  0.0); HAL_Delay(600);
            }
            else{
                car_move( 0.0,  0.15,  0.0);
                HAL_Delay(30);
            }
        }
        //------------------------------------------------------------road 2
        if(obstacle_numbers == 2){
            if(ult_sta == 4){
                car_move( 0.0,  -0.15,  0.0); HAL_Delay(1500);
                led_off(3);
                road_flag = false;
                ult_flag = true;
                car_move( 0.0,  0.0,  0.0); HAL_Delay(600);
            }
            else{
                car_move( 0.0,  -0.15,  0.0);
                HAL_Delay(30);
            }
        }
        //------------------------------------------------------------road 3
        if(obstacle_numbers == 3){
            if(ult_sta == 4){
                car_move( 0.0,  0.15,  0.0); HAL_Delay(1500);
                led_off(3);
                road_flag = false;
                ult_flag = true;
                car_move( 0.0,  0.0,  0.0); HAL_Delay(600);
            }
            else{
                car_move( 0.0,  0.15,  0.0);
                HAL_Delay(30);
            }
        }
        //------------------------------------------------------------road 4
        if(obstacle_numbers == 4){
            if(ult_sta == 4){
                car_move( 0.0,  -0.15,  0.0); HAL_Delay(1500);
                led_off(3);
                road_flag = false;
                ult_flag = true;
                car_move( 0.0,  0.0,  0.0); HAL_Delay(600);
            }
            else{
                car_move( 0.0,  -0.15,  0.0);
                HAL_Delay(30);
            }
        }
    }
    //*/

  }
  /* USER CODE END 3 */
}

uint16_t get_ult_status(float ult1_distance, float ult2_distance, float ult_distance_min){
    Hcsr04Start(1);                       //ultrasonic 1 start
    ult1_dis = Hcsr04Read(1);             //get ultrasonic 1 distance
    Hcsr04Start(2);                       //ultrasonic 2 start
    ult2_dis = Hcsr04Read(2);             //get ultrasonic 2 distance
    //printf("ult1: %f ult2: %f\r\n", ult1_dis, ult2_dis);
    //HAL_Delay(20);

    //If ultrasound j1 detects obstacles, ultrasound j2 does not detect obstacles
    if( ((ult1_dis < ult1_distance) && (ult1_dis > ult_distance_min)) && (ult2_dis > ult2_distance) ){
        ultrasonic_status = 1;
        led_open(1);
        led_off(2);
    }

    //If ultrasound j2 detects obstacles, ultrasound j1 does not detect obstacles
    else if( ((ult2_dis < ult2_distance) && (ult2_dis > ult_distance_min)) && (ult1_dis > ult1_distance) ){
        ultrasonic_status = 2;
        led_off(1);
        led_open(2);
    }

    //If ultrasound j1 and j2 detects obstacles
    else if
        ( ((ult1_dis <= ult1_distance) && (ult1_dis > ult_distance_min)) && 
        ((ult2_dis <= ult2_distance) && (ult2_dis > ult_distance_min)) ) {
        ultrasonic_status = 3;
        //obstacle_numbers = obstacle_numbers + 1;
        led_open(1);
        led_open(2);
    }
    //otherwise
    else{
        ultrasonic_status = 4;
        led_off(1);
        led_off(2);
    }
    return ultrasonic_status;
}
/**
  * @brief System Clock Configuration
  * @retval None
  */
void SystemClock_Config(void)
{
  RCC_OscInitTypeDef RCC_OscInitStruct = {0};
  RCC_ClkInitTypeDef RCC_ClkInitStruct = {0};

  /** Configure the main internal regulator output voltage
  */
  __HAL_RCC_PWR_CLK_ENABLE();
  __HAL_PWR_VOLTAGESCALING_CONFIG(PWR_REGULATOR_VOLTAGE_SCALE1);

  /** Initializes the RCC Oscillators according to the specified parameters
  * in the RCC_OscInitTypeDef structure.
  */
  RCC_OscInitStruct.OscillatorType = RCC_OSCILLATORTYPE_HSE;
  RCC_OscInitStruct.HSEState = RCC_HSE_ON;
  RCC_OscInitStruct.PLL.PLLState = RCC_PLL_ON;
  RCC_OscInitStruct.PLL.PLLSource = RCC_PLLSOURCE_HSE;
  RCC_OscInitStruct.PLL.PLLM = 4;
  RCC_OscInitStruct.PLL.PLLN = 84;
  RCC_OscInitStruct.PLL.PLLP = RCC_PLLP_DIV2;
  RCC_OscInitStruct.PLL.PLLQ = 4;
  if (HAL_RCC_OscConfig(&RCC_OscInitStruct) != HAL_OK)
  {
    Error_Handler();
  }

  /** Initializes the CPU, AHB and APB buses clocks
  */
  RCC_ClkInitStruct.ClockType = RCC_CLOCKTYPE_HCLK|RCC_CLOCKTYPE_SYSCLK
                              |RCC_CLOCKTYPE_PCLK1|RCC_CLOCKTYPE_PCLK2;
  RCC_ClkInitStruct.SYSCLKSource = RCC_SYSCLKSOURCE_PLLCLK;
  RCC_ClkInitStruct.AHBCLKDivider = RCC_SYSCLK_DIV1;
  RCC_ClkInitStruct.APB1CLKDivider = RCC_HCLK_DIV2;
  RCC_ClkInitStruct.APB2CLKDivider = RCC_HCLK_DIV1;

  if (HAL_RCC_ClockConfig(&RCC_ClkInitStruct, FLASH_LATENCY_2) != HAL_OK)
  {
    Error_Handler();
  }
}

/* USER CODE BEGIN 4 */
void HAL_TIM_PeriodElapsedCallback(TIM_HandleTypeDef *htim)
{
  if(htim->Instance == TIM6){
    update(&m1);
    update(&m2);
    update(&m3);
    update(&m4);
  }
  if(htim->Instance == TIM1){
    Hcsr04TimOverflowIsr(htim);
  }
}

void HAL_TIM_IC_CaptureCallback(TIM_HandleTypeDef *htim)
{
    Hcsr04TimIcIsr(htim);
}
/* USER CODE END 4 */

/**
  * @brief  This function is executed in case of error occurrence.
  * @retval None
  */
void Error_Handler(void)
{
  /* USER CODE BEGIN Error_Handler_Debug */
  /* User can add his own implementation to report the HAL error return state */
  __disable_irq();
  while (1)
  {
  }
  /* USER CODE END Error_Handler_Debug */
}

#ifdef  USE_FULL_ASSERT
/**
  * @brief  Reports the name of the source file and the source line number
  *         where the assert_param error has occurred.
  * @param  file: pointer to the source file name
  * @param  line: assert_param error line source number
  * @retval None
  */
void assert_failed(uint8_t *file, uint32_t line)
{
  /* USER CODE BEGIN 6 */
  /* User can add his own implementation to report the file name and line number,
     ex: printf("Wrong parameters value: file %s on line %d\r\n", file, line) */
  /* USER CODE END 6 */
}
#endif /* USE_FULL_ASSERT */

操作手順：

全体の流れ：

（1）STM32CubeMX でピン割り当てと周辺機能の初期化設定を行い、設定コードを生成します。

（2）Keil5 で MDK_ARM プロジェクトファイルを開き、コードの編集・コンパイル・デバッグを行います。

基本パラメータ：

本ドキュメントの（ハードウェアモジュール）に従って開発環境の設定を完了すると、基本パラメータは以下のようになります。

ソフトウェアバージョン：STM32CubeMX V6.14.0

ハードウェアプラットフォーム：STM32F407IGT6

コンパイル環境：MDK_ARM V5.3.2

デバッグツール：ST-LINK/V2

1. 新規プロジェクトの作成と MCU の設定

1.1 MCU の選択

STM32CubeMX を起動し、File > New Project をクリックします。

2. MCU の絞り込み条件を設定して STM32F407IGT6 を選択し、続いて型番の列をクリックし、最後に Start Project をクリックしてプロジェクトの設定を開始します。

プロジェクト設定画面は以下のとおりです。

1.2 クロック設定とコア設定

Pinout & Configuration の System Core で RCC（リセットおよびクロック制御） をクリックします。

HSE のクロックソースを Crystal/Ceramic Resonator（水晶またはセラミック発振子）に設定します。

設定が完了すると、対応するピン（OSC_IN と OSC_OUT）が自動的に設定されます（下図の緑色部分を参照）。

機能：

外部高速水晶発振子（HSE）を接続し、システムに高精度なクロックソースを供給します。

**RCC_OSC_IN**：水晶発振子の入力ピン。

**RCC_OSC_OUT**：水晶発振子の出力ピン（帰還信号）。

デフォルト機能：

**PH0**：**OSC_IN**（外部水晶発振子入力）。

**PH1**：**OSC_OUT**（外部水晶発振子出力）。

デバッグインターフェースのピンを設定します。System Core で SYS をクリックし、Debug モードを Serial Wire に設定します。

設定が完了すると、対応するピン出力（pinout）が緑色になります。

緑色の部分をクリックすると、具体的な内容を確認できます。

1.3 クロックツリーの設定

次の順序でクロックパラメータを設定します。1. input frequency の値を 8 に変更、2. HSE を選択、3. PLLCLK を選択、4. HCLK の値を 84 に変更。その他のパラメータはデフォルトのままで構いません。

ヒント：設定時にはエラーが自動的に検出されます。周波数の設定が誤っている場合は、赤色でハイライト表示されます。

2. MCU 初期化パラメータの設定

2.1 USART シリアルポートの設定

PA9 と PA10 を USART1_TX と USART1_RX に設定します。GPIO をクリックし、ピンを設定します（この時点では USART1 が未設定のため、ピンには黄色の警告が表示されます）。

Connectivity → USART1 をクリックし、モードを Asynchronous に設定します（USART1 の設定後、関連するピンが緑色になり、ピン設定が正常であることを示します）。

2.2 プロジェクト管理の設定

デフォルトの画面は以下のとおりです。

プロジェクト名を入力します（任意の名前で構いません）。

プロジェクトの保存先を選択します（C ドライブには保存しないでください）。

コンパイル環境として MDK_ARM を選択します。

バージョン V5.3.2 を選択します。

ファームウェアパッケージ名とバージョン。

（ヒント：デフォルトでは Use latest available version にチェックが入っています。ただし、お使いの PC に最新バージョンがない場合はエラーになるため、パッケージを自分でダウンロードしてローカルインストールする必要があります。インストール方法は以下のリンクを参照してください。

UNI-STM32 開発環境の設定【V2.0】（リンク先の「6. よくある設定 Q&A」の Q3 に解決方法があります）

上記の設定が完了すると、下図のようになります。

2. Project Manager > Code Generator ウィンドウを以下のように設定します。

3. Project Manager > Advanced Settings ウィンドウで HAL ライブラリを選択します。

File → Save Project をクリックしてプロジェクトを保存します。

3. GPIO の設定：モーター 4 個と超音波センサー 2 個

M3 モーターのパラメータ設定

モーター	ピン	パラメータ	ユーザーラベル
M3	PC8	TIM8_CH3
	PC9	TIM8_CH4
	PE9	GPIO_EXTI9	M3A
	PE11	GPIO_Input	M3B

GPIO をクリックし、PC8、PC9 ピンを探します。

ピン配置図で PC8 を左クリックして機能を TIM8_CH3 に、PC9 を左クリックして機能を TIM8_CH4 に設定します（下図参照）。（注意：ピン割り当てが完了するとピンはオレンジ色になります。これはピン割り当てのみが完了し、対応する周辺機能がまだ有効化されていないことを示します。）

左側の Timers パネルをクリックし、TIM8 を選択してパラメータを設定します。

Channel3（チャネル 3）：PWM Generation CH3
Channel4（チャネル 4）：PWM Generation CH4

これでピンの色が緑色に変わり、設定が正常に完了したことを示します。

GPIO をクリックし、画面下部で PE11 を検索すると、ピンビュー上の PE11 が点滅します。

PE11 を左クリックし、GPIO_Input を選択します。

ユーザーラベルの設定：Configuration を開き、PE11 の行をダブルクリックします。GPIO mode 右側のドロップダウンで Input mode を選択し、User Label に M3B と入力します。

GPIO をクリックし、画面下部で PE9 を検索すると、ピンビュー上の PE9 が点滅します。PE9 を左クリックし、GPIO_EXTI9 を選択します。

ユーザーラベルの設定：Configuration を開き、PE9 の行をダブルクリックします。GPIO mode 右側のドロップダウンで External Interrupt Mode with Rising/Falling edge trigger detection を選択し、User Label に M3A と入力します。

M4 モーターのパラメータ設定

モーター	ピン	パラメータ	ユーザーラベル
M4	PH10	TIM5_CH1
	PH11	TIM5_CH2
	PD12	GPIO_EXTI12	M4A
	PD13	GPIO_Input	M4B

M3 の設定方法を参考にしてください。M4 モーターのパラメータ設定後の状態は以下のとおりです。

M5 モーターのパラメータ設定

モーター	ピン	パラメータ	ユーザーラベル
M5	PC6	TIM8_CH1
	PC7	TIM8_CH2
	PA0	GPIO_EXTI0	M5A
	PA1	GPIO_Input	M5B

M3 の設定方法を参考にしてください。M5 モーターのパラメータ設定後の状態は以下のとおりです。

M6 モーターのパラメータ設定

モーター	ピン	パラメータ	ユーザーラベル
M6	PH12	TIM5_CH3
	PI0	TIM5_CH4
	PA6	GPIO_EXTI6	M6A
	PA7	GPIO_Input	M6B

M3 の設定方法を参考にしてください。M6 モーターのパラメータ設定後の状態は以下のとおりです。

モーターの割り込み設定

タイマーの役割の比較：

モーター用タイマー（TIMxx）：モーターの PWM 出力に使用します。

TIM6：制御アルゴリズムの実行周期用タイマーです。

（1）TIM6 をクリックし、Activated にチェックを入れます。下部の NVIC Settings をクリックし、Enabled にチェックを入れます。

（2）GPIO をクリックして NVIC を選択し、モーターの外部割り込みについて Enabled にチェックを入れます。

J1 超音波センサーのパラメータ

超音波センサーのピン	機能	ユーザーラベル
PA4	出力	TRIG1
PA8	TIM1_CH1	Echo 1

GPIO をクリックし、画面下部で PA4 を検索すると、ピンビュー上の PA4 が点滅します。

PA4 を左クリックし、GPIO_Output を選択します。

ユーザーラベルの設定：Configuration を開き、PA4 の行をダブルクリックします。GPIO mode 右側のドロップダウンで Output Push Pull を選択し、User Label に TRIG1 と入力します。

PA8 のパラメータ設定

（1）画面下部で PA8 を検索すると、ピンビュー上の PA8 が点滅します。PA8 を左クリックし、TIM1_CH1 を選択します。

PA8 を右クリックして Enter User Label を開き、Echo 1 と入力してユーザーラベルを変更します。

（2）タイマーと割り込みの設定

TIM1 をクリックし、Channel のドロップダウンで Input Capture direct mode を選択します。

NVIC Settings をクリックし、Enabled にチェックを入れます。

J2 超音波センサーのパラメータ

超音波センサーのピン	機能	ユーザーラベル
PA5	GPIO_Output	TRIG2
PB3	TIM2_CH2	Echo 2

GPIO をクリックし、画面下部で PA5 を検索すると、ピンビュー上の PA5 が点滅します。PA5 を左クリックし、GPIO_Output を選択します。

ユーザーラベルの設定：Configuration を開き、PA5 の行をダブルクリックします。GPIO mode 右側のドロップダウンで Output Push Pull を選択し、User Label に TRIG2 と入力します。

PB3 のパラメータ設定

（1）画面下部で PB3 を検索すると、ピンビュー上の PB3 が点滅します。PB3 を左クリックし、TIM2_CH2 を選択します。

PB3 を右クリックして Enter User Label を開き、Echo 2 と入力してユーザーラベルを変更します。

（2）タイマーと割り込みの設定

TIM2 をクリックし、Channel のドロップダウンで Input Capture direct mode を選択します。

NVIC Settings をクリックし、Enabled にチェックを入れます。（注意：TIM2 の割り込みは TIM1 の割り込みとは異なります。）

プロジェクトファイルを再度保存します。

ヒント：必ずプロジェクトファイルを再度保存してください（主にパラメータを保存するためです）。File → Save Project をクリックします。

4. コードの生成

1. GENERATE CODE をクリックしてコードを生成します。

コードが自動生成されます。

コードの生成に成功しました。

5. ユーザーコードの追加

上記で生成したフレームワークをもとに、Keil エディタでユーザーコードを追加し、コンパイル・デバッグを行います。

ヒント 1：たとえば main.c では、/* USER CODE BEGIN xx */ と /* USER CODE END xx */ の間にユーザーコードを追加します。

ヒント 2：独自の .c ファイルを作成しても構いません。

ヒント 3：ユーザーコードは自分で書いても構いませんが、（コード解説）に掲載している例を参考にして学ぶこともできます。

6. コードのダウンロードとテスト

（1）プロジェクトをダウンロードします。デモを用意しています（本ドキュメントの「ソフトウェア設計 → プロジェクトのダウンロード」から直接ダウンロードできます）。

参考リンク（UNI-STM32 開発環境の設定【V2.0】の「5. プログラムのダウンロード」）を参照してください。

（2）メインボードのスイッチをオンにし、動作を確認します。

実験結果

超音波センサー 1 が障害物を検出し（距離が sth_dis1 = 20.0cm 未満）、超音波センサー 2 が障害物を検出していない場合、車体は 1 秒間後退してから 1 秒間右に旋回します。超音波センサー 2 が障害物を検出し（距離が sth_dis2 = 20.0cm 未満）、超音波センサー 1 が障害物を検出していない場合、車体は 1 秒間後退してから 1 秒間左に旋回します。それ以外の場合、車体は移動を続けます。

コード解説

1. ユーザーコードの解説

下図は、プロジェクトファイルに追加したユーザーコードを示しています。

2. ユーザーコードの取り込み方法

1 つ目は、ユーザー定義のファイル（.c、.h など）を自分のプロジェクトに取り込み、Keil5 IDE で .c ファイルを追加してコンパイルする方法です。

既存のユーザーファイルの取り込み：Keil で既存のユーザーファイルを取り込む方法を参照してください。

2 つ目は、main.c ファイルにユーザーコードを追加する方法です。

（1）まず参考プロジェクトのコードを開きます。main.c ファイルは主に STM32CubeMX によって自動生成されます。このフレームワークをもとに、実現したい機能を補完していきます。具体的には /* USER xx/ で始まり終わる部分の間のコードを確認してください。以下の赤枠部分が記入したユーザーコードです。

 /* USER CODE BEGIN 2 */
  HAL_Delay(18000);
  Hcsr04Init(&htim1, TIM_CHANNEL_1);      //Ultrasonic1 init
  Hcsr04Start(1);                         //Ultrasonic1 init
  Hcsr04Init(&htim2, TIM_CHANNEL_2);      //Ultrasonic2 init
  Hcsr04Start(2);                         //Ultrasonic2 init

  Motor_Init();                           //motor init
  dwt_init();                             //DWT_start
  enable(&m1);                            //m3 enable
  enable(&m2);                            //m4 enable
  enable(&m3);                            //m5 enable
  enable(&m4);                            //m6 enable

  //If omitted here, the radius defaults to 0.0325
  set_radius(&m1, 0.0475);                //set m3 wheel radius. unit: m
  set_radius(&m2, 0.0475);                //set m4 wheel radius. unit: m
  set_radius(&m3, 0.0475);                //set m5 wheel radius. unit: m
  set_radius(&m4, 0.0475);                //set m6 wheel radius. unit: m

  HAL_TIM_Base_Start_IT(&htim6);          //Base TIM6 start
  ult_flag = true;
  road_flag = false;
  /* USER CODE END 2 */

  /* Infinite loop */
  /* USER CODE BEGIN WHILE */
  while (1)
  {
    /* USER CODE END WHILE */

    /* USER CODE BEGIN 3 */
    if(ult_flag == true){

        ult_sta = get_ult_status(sth_dis1, sth_dis2, min_dis);
        printf("ult_sta: %d\r\n", ult_sta);

        if(ult_sta == 3){
            car_move( 0.0,  0.0,  0.0); HAL_Delay(600);
            ult_flag = false;
            road_flag = true;
            obstacle_numbers = obstacle_numbers + 1;
            led_open(3);
        }
        else{
            car_move( 0.15,  0.0,  0.0);
            HAL_Delay(30);
        }
    }
    ///*
    if(road_flag == true){
        ult_sta = get_ult_status(sth_dis1 + 8, sth_dis2 + 8, min_dis);
        //------------------------------------------------------------road 1
        if(obstacle_numbers == 1){
            if(ult_sta == 4){
                car_move( 0.0,  0.15,  0.0); HAL_Delay(1500);
                led_off(3);
                road_flag = false;
                ult_flag = true;
                car_move( 0.0,  0.0,  0.0); HAL_Delay(600);
            }
            else{
                car_move( 0.0,  0.15,  0.0);
                HAL_Delay(30);
            }
        }
        //------------------------------------------------------------road 2
        if(obstacle_numbers == 2){
            if(ult_sta == 4){
                car_move( 0.0,  -0.15,  0.0); HAL_Delay(1500);
                led_off(3);
                road_flag = false;
                ult_flag = true;
                car_move( 0.0,  0.0,  0.0); HAL_Delay(600);
            }
            else{
                car_move( 0.0,  -0.15,  0.0);
                HAL_Delay(30);
            }
        }
        //------------------------------------------------------------road 3
        if(obstacle_numbers == 3){
            if(ult_sta == 4){
                car_move( 0.0,  0.15,  0.0); HAL_Delay(1500);
                led_off(3);
                road_flag = false;
                ult_flag = true;
                car_move( 0.0,  0.0,  0.0); HAL_Delay(600);
            }
            else{
                car_move( 0.0,  0.15,  0.0);
                HAL_Delay(30);
            }
        }
        //------------------------------------------------------------road 4
        if(obstacle_numbers == 4){
            if(ult_sta == 4){
                car_move( 0.0,  -0.15,  0.0); HAL_Delay(1500);
                led_off(3);
                road_flag = false;
                ult_flag = true;
                car_move( 0.0,  0.0,  0.0); HAL_Delay(600);
            }
            else{
                car_move( 0.0,  -0.15,  0.0);
                HAL_Delay(30);
            }
        }
    }
    //*/

  }
  /* USER CODE END 3 */
}

（2）上記の赤枠部分のコードを自分のプロジェクトの main.c にコピーし、コンパイル・ダウンロードすると動作を確認できます。

技術サポート

資料のダウンロード・技術サポートについては、HumansX株式会社までお問い合わせください。