1. 功能说明

本文示例将实现R326样机机器龙边张合嘴巴、边煽动翅膀、边摆动尾巴运动的功能。

2. 结构说明

本项目使用的机器龙样机是用可以用探索者零件或者探索者兼容零件制作。样机主要由头部模块、翅膀模块、尾巴模块、四足行走模块四部分组成。其中头部模块由2自由度并联关节模组和迷你夹爪模组构成，翅膀模块来自机器鸟，尾巴模块来自机器鱼，四足行走模块来自机器小狗。

3. 电子硬件

在这个示例中，我们采用了以下硬件，请大家参考：

主控板	Basra主控板（兼容Arduino Uno）‍
扩展板	Bigfish2.1扩展板‍
电池	7.4V锂电池

电路连接：机器龙翅膀模块上的两个舵机连接在Bigfish扩展板的D7、D11；

机器龙脖子上的两个舵机连接在Bigfish扩展板的D3、D8；

机器龙嘴巴上的舵机连接在Bigfish扩展板的D4；

机器龙尾巴上的舵机连接在Bigfish扩展板的D12。

4. 功能实现

编程环境：Arduino 1.8.19

实现思路：实现机器龙边张合嘴巴、边扇动翅膀、边摆动尾巴运动的功能。

将参考例程（long.ino）下载到主控板，实验效果可参考官网演示视频。


概述
样机-【R326】机器龙-概述-图1

1. 功能说明

       本文示例将实现R326样机机器龙边张合嘴巴、边煽动翅膀、边摆动尾巴运动的功能。

2. 结构说明

       本项目使用的机器龙样机是用可以用探索者零件或者探索者兼容零件制作。样机主要由头部模块、翅膀模块、尾巴模块、四足行走模块四部分组成。其中头部模块由2自由度并联关节模组和迷你夹爪模组构成，翅膀模块来自机器鸟，尾巴模块来自机器鱼，四足行走模块来自机器小狗。

概述
样机-【R326】机器龙-概述-图2
样机-【R326】机器龙-概述-图3

3. 电子硬件

       在这个示例中，我们采用了以下硬件，请大家参考：
主控板	

Basra主控板（兼容Arduino Uno）‍
扩展板	

Bigfish2.1扩展板‍
电池	7.4V锂电池


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

  版权说明：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-10 https://www.robotway.com/

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

#include <Servo.h>


Servo servo_c0;

Servo servo_c1;

Servo servo_w;

Servo servo_z;

Servo servo_b0;

Servo servo_b1;



int init_c = 90;

int init_w = 90;

int init_z = 90;

int init_b0 = 90;

int init_b1 = 90;


int i = 0;

int j = 0;



void setup() {

  // put your setup code here, to run once:

  Serial.begin(9600);

  servo_c0.attach(7);

  servo_c1.attach(11);

  servo_w.attach(12);

  servo_z.attach(4);

  servo_b0.attach(3);

  servo_b1.attach(8);

  servo_b0.write(50);

  servo_b1.write(50);

  servo_c0.write(90);

  servo_c0.write(90);

  delay(15);

  servo_c0.write(0);

}


void loop() {

  for(i = 90;i>=30;i-=2)

  {

    j = i+30;

    servo_c1.write(j);

    servo_c0.write(i);

    servo_z.write(i);

    j-=4;

    delay(50);

  }

    for(i = 70; i <= 110; i+=3)

  {

    servo_w.write(i);

    delay(15);

  }

      for(i = 30;i<=90;i+=2)

  {

    j = 0;

    servo_c1.write(j);

    servo_c0.write(i);

    servo_z.write(i);

    j+=4;

    delay(50);

  }

  for(i = 110; i >= 70; i-=3)

  {

    servo_w.write(i);

    delay(15);

  }

}