機(jī)器魚(yú)胸鰭上下擺動(dòng)功能的實(shí)現(xiàn)

1. 運(yùn)動(dòng)功能說(shuō)明

本文示例將實(shí)現(xiàn)R330樣機(jī)機(jī)器魚(yú)胸鰭能夠靈活的上下擺動(dòng)的功能。

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

本樣機(jī)采用舵機(jī)模塊來(lái)進(jìn)行仿生機(jī)器魚(yú)結(jié)構(gòu)的設(shè)計(jì)。

胸鰭 整機(jī)

3. 電子硬件

在這個(gè)示例中，我們采用了以下硬件，請(qǐng)大家參考：

電路連接：將舵機(jī)連接在Bigfish擴(kuò)展板的D4端口。

4. 運(yùn)動(dòng)功能實(shí)現(xiàn)

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

下面提供一個(gè)機(jī)器魚(yú)胸鰭上下擺動(dòng)的參考例程（fishQi.ino），例程源代碼詳見(jiàn)（https://www.robotway.com/h-col-236.html），實(shí)驗(yàn)效果可參考網(wǎng)站演示視頻。

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

  版權(quán)說(shuō)明：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 機(jī)器譜 2023-05-23 https://www.robotway.com/

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

#include 


int _ABVAR_1_angle_current2 = 0 ;

int _ABVAR_2_num = 0 ;

Servo servo_pin_4;

int _ABVAR_3_angle_current1 = 0 ;


void up_down();

void down_up();


void setup()

{

  servo_pin_4.attach(4);

}


void loop()

{

  down_up();

  up_down();

}


void down_up()

{

  _ABVAR_1_angle_current2 = 30 ;

  for (_ABVAR_2_num= 1; _ABVAR_2_num<= ( 16 ); _ABVAR_2_num++ )

  {

    _ABVAR_1_angle_current2 = ( _ABVAR_1_angle_current2 + 5 ) ;

    servo_pin_4.write( _ABVAR_1_angle_current2 );

    delay( 50 );

  }

}


void up_down()

{

  _ABVAR_3_angle_current1 = 110 ;

  for (_ABVAR_2_num= 1; _ABVAR_2_num<= ( 16 ); _ABVAR_2_num++ )

  {

    _ABVAR_3_angle_current1 = ( _ABVAR_3_angle_current1 - 5 ) ;

    servo_pin_4.write( _ABVAR_3_angle_current1 );

    delay( 50 );

  }

}

下面再給大家提供一個(gè)機(jī)器魚(yú)魚(yú)尾擺動(dòng)的參考例程（fishTail.ino），大家可以嘗試改寫(xiě)一下舵機(jī)擺動(dòng)角度參數(shù)，讓機(jī)器魚(yú)尾能夠靈活的擺動(dòng)。

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

  版權(quán)說(shuō)明：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 機(jī)器譜 2023-05-23 https://www.robotway.com/

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

#include 


int _ABVAR_1_angle_right = 0 ;

int _ABVAR_2_num = 0 ;

Servo servo_pin_4;

int _ABVAR_3_angle_left = 0 ;


void Right_Left();

void left_Right();


void setup()

{

  servo_pin_4.attach(4);

}


void loop()

{

  left_Right();

  Right_Left();

}


void Right_Left()

{

  _ABVAR_1_angle_right = 70 ;

  for (_ABVAR_2_num= 1; _ABVAR_2_num<= ( 8 ); _ABVAR_2_num++ )

  {

    _ABVAR_1_angle_right = ( _ABVAR_1_angle_right + 5 ) ;

    servo_pin_4.write( _ABVAR_1_angle_right );

    delay( 100 );

  }

}


void left_Right()

{

  _ABVAR_3_angle_left = 110 ;

  for (_ABVAR_2_num= 1; _ABVAR_2_num<= ( 8 ); _ABVAR_2_num++ )

  {

    _ABVAR_3_angle_left = ( _ABVAR_3_angle_left - 5 ) ;

    servo_pin_4.write( _ABVAR_3_angle_left );

    delay( 100 );

  }

}

審核編輯黃宇