1. 運(yùn)動功能說明

R204樣機(jī)是一款擁有4個自由度的串聯(lián)機(jī)械臂。本文示例實(shí)現(xiàn)4自由度串聯(lián)機(jī)械臂抓取物品、放下的功能。

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

R204號樣機(jī)由4個串聯(lián)的 舵機(jī)關(guān)節(jié)模組 和1個 舵機(jī)夾爪模組 組成。

為了增加減輕腰關(guān)節(jié)的負(fù)擔(dān)，在腰關(guān)節(jié)位置加裝了4根拉簧。

3. 運(yùn)動功能實(shí)現(xiàn)

3.1 電子硬件

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

3.2 編寫程序

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

編寫并燒錄以下程序（grab_thing_anwser.ino），該程序?qū)?shí)現(xiàn)演示動圖中的動作【詳細(xì)例程源代碼請參考 https://www.robotway.com/h-col-189.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 機(jī)器譜 2023-02-02 https://www.robotway.com/

  ------------------------------

  實(shí)驗(yàn)功能： 實(shí)現(xiàn)4自由度串聯(lián)機(jī)械臂抓取物品、放下的功能

  -----------------------------------------------------

  實(shí)驗(yàn)接線：舵機(jī)接口依次D8、D3、D11、D7、D4                                     

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

int a=0,b=0,c=0,d=0,e=0,f=0;

#include 

Servo servo_pin_4;

Servo servo_pin_7;

Servo servo_pin_11;

Servo servo_pin_3;

Servo servo_pin_8;

void setup()

{

  servo_pin_4.attach(4);

  servo_pin_4.write( 76);

  servo_pin_7.attach(7);

  servo_pin_7.write( 110);

  servo_pin_11.attach(11);

  servo_pin_11.write(68);

  servo_pin_3.attach(3);

  servo_pin_3.write(157);

  servo_pin_8.attach(8);

  servo_pin_8.write(81);

  delay(3000);//set up the initial posotion.Each servo is different,

              // so u must use Software of Processing to monitor your initial positions of servo.

}

void loop()

{

  int a=76;b=110;c=68;d=157;e=81;

  servo_pin_4.write(a);

  servo_pin_7.write(b);

  servo_pin_11.write(c);

  servo_pin_3.write(d);

  servo_pin_8.write(e);

  //Now begin to move,you can use Processing to record a serials of movements.

  //Here's my records.Aiming to grab a thing and put it back.

  for(e=80;e>=50;e-=1)           

  {servo_pin_8.write(e);delay(30);}  

 

  for(d=158;d>=62;d-=3)

  {servo_pin_3.write(d);delay(30);}

 

  for(b=110;b>=19;b-=3)

  {servo_pin_7.write(b); delay(30);}



 

  for(e=50;e<=80;e+=1)

  {servo_pin_8.write(e);delay(30);}

 

     for(b=19;b<=110;b+=3)

  {servo_pin_7.write(b);delay(30);}

  delay(3000);



      for(b=110;b>=19;b-=3)

  {servo_pin_7.write(b);delay(30);}

 

   

  for(e=80;e>=50;e-=1)

  {servo_pin_8.write(e);delay(30);}

 

   for(b=19;b<=110;b+=3)

  {servo_pin_7.write(b);delay(30);}

 

    for(d=62;d<=158;d+=3)

  {servo_pin_3.write(d);delay(30);}

 

    for(e=50;e<=81;e+=1)

  {servo_pin_8.write(e);delay(30);}

 

}

審核編輯黃宇