1. 功能說明

本文示例將實現(xiàn)R329樣機機器鳥扇動翅膀的功能。

2. 結(jié)構(gòu)說明

鳥類的翅膀主要由肩關(guān)節(jié)、肘關(guān)節(jié)、腕關(guān)節(jié)組成，本樣機利用組合機構(gòu)設(shè)計機器鳥的撲翼機構(gòu)。

3. 電子硬件

在這個示例中，我們采用了以下硬件，請大家參考：

電路連接：將舵機連接在Bigfish擴展板的D3端口。

4. 功能實現(xiàn)

編程環(huán)境：Arduino 1.8.19

下面提供一個機器鳥扇動翅膀的參考例程（Bird_Wing_Fly.ino），例程源代碼及樣機3D文件詳見【 https://www.robotway.com/h-col-231.html 】，實驗效果可參考演示視頻。

/*------------------------------------------------------------------------------------

  版權(quán)說明：Copyright 2023 Robottime(Beijing) Technology Co., Ltd. All Rights Reserved.

           Distributed under MIT license.See file LICENSE for detail or copy at

           https://opensource.org/licenses/MIT

           by 機器譜 2023-05-24 https://www.robotway.com/

  ------------------------------*/

#include 


int _ABVAR_1_Subdivision_number = 0 ;

int _ABVAR_2_Flags = 0 ;

Servo servo_pin_3;

int _ABVAR_3_Servo3_Start = 0 ;

int _ABVAR_4_Servo3_End = 0 ;

int _ABVAR_5_Angle_Of_Each_Time = 0 ;

int _ABVAR_6_value1 = 0 ;

int _ABVAR_7_Angle_Of_Change = 0 ;

int _ABVAR_8_value2 = 0 ;


void Wing_Open();

void Wing_Close();


void setup()

{

  servo_pin_3.attach(3);

  _ABVAR_1_Subdivision_number = 14 ;


  _ABVAR_2_Flags = 0 ;


  servo_pin_3.write( 80 );


  delay( 1000 );


}


void loop()

{

  Wing_Close();

  Wing_Open();

}


void Wing_Close()

{

  _ABVAR_3_Servo3_Start = 10 ;

  _ABVAR_4_Servo3_End = 80 ;

  _ABVAR_5_Angle_Of_Each_Time = ( abs( ( _ABVAR_3_Servo3_Start - _ABVAR_4_Servo3_End ) ) / _ABVAR_1_Subdivision_number ) ;

  if (( ( ( _ABVAR_3_Servo3_Start - _ABVAR_4_Servo3_End ) ) > ( 1 ) ))

  {

    _ABVAR_2_Flags = -1 ;

  }

  else

  {

    _ABVAR_2_Flags = 1 ;

  }

  for (_ABVAR_6_value1= 1; _ABVAR_6_value1<= ( ( _ABVAR_1_Subdivision_number + 1 ) ); _ABVAR_6_value1++ )

  {

    _ABVAR_7_Angle_Of_Change = ( _ABVAR_3_Servo3_Start + ( _ABVAR_5_Angle_Of_Each_Time * _ABVAR_2_Flags ) ) ;

    servo_pin_3.write( _ABVAR_7_Angle_Of_Change );

    _ABVAR_3_Servo3_Start = _ABVAR_7_Angle_Of_Change ;

    delay( 28 );

  }

}


void Wing_Open()

{

  _ABVAR_3_Servo3_Start = 80 ;

  _ABVAR_4_Servo3_End = 10 ;

  _ABVAR_5_Angle_Of_Each_Time = ( abs( ( _ABVAR_3_Servo3_Start - _ABVAR_4_Servo3_End ) ) / _ABVAR_1_Subdivision_number ) ;

  if (( ( ( _ABVAR_3_Servo3_Start - _ABVAR_4_Servo3_End ) ) > ( 1 ) ))

  {

    _ABVAR_2_Flags = -1 ;

  }

  else

  {

    _ABVAR_2_Flags = 1 ;

  }

  for (_ABVAR_8_value2= 1; _ABVAR_8_value2<= ( ( _ABVAR_1_Subdivision_number + 1 ) ); _ABVAR_8_value2++ )

  {

    _ABVAR_7_Angle_Of_Change = ( _ABVAR_3_Servo3_Start + ( _ABVAR_5_Angle_Of_Each_Time * _ABVAR_2_Flags ) ) ;

    servo_pin_3.write( _ABVAR_7_Angle_Of_Change );

    _ABVAR_3_Servo3_Start = _ABVAR_7_Angle_Of_Change ;

    delay( 65 );

  }

}


審核編輯 黃宇