如何驱动模拟舵机-Controller 1.0b软件的使用

1.支持平台

   win10、win7

       win10打开Controller 1.0.exe即可运行;win7需要先安装Controller1.0b资料包\NetFarmwork文件夹中的.net框架组件。

2.电子硬件

   我们用以下硬件为例来讲解Controller 1.0b软件的使用:

主控板

Basra主控板(兼容Arduino Uno)

扩展板

Bigfish2.1扩展板

SH-SR舵机扩展板

3.操作步骤

上位机:Controller 1.0

下位机编程环境:Arduino 1.8.19

① 使用 SH-SR舵机扩展板 调试舵机时,将Controller1.0b资料包\Arduino\servo\servo.ino下载到主控板;

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

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

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

#include <Tlc5940.h>

#include <tlc_servos.h>


#define ANGLE_VALUE_MIN 0

#define ANGLE_VALUE_MAX 180

#define PWM_VALUE_MIN 500

#define PWM_VALUE_MAX 2500


int data_array[2] = {0,0};   //servo_pin: data_array[0], servo_value: data_array[1];

String data = "";


boolean dataComplete = false;


void setup() {

  Serial.begin(9600);

  Tlc.init(0);

  tlc_initServos();

  delay(1000);

}


void loop() {

 

  while(Serial.available())

  {

    int B_flag, P_flag, T_flag;

    data = Serial.readStringUntil('\n');

    data.trim();

    for(int i=0;i<data.length();i++)

    {

      //Serial.println(data[i]);

      switch(data[i])

      {

        case '#':

          B_flag = i;  

        break;

        case 'P':

        {

          String pin = "";

          P_flag = i;

          for(int i=B_flag+1;i<P_flag;i++)

          {

            pin+=data[i];

          }

          data_array[0] = pin.toInt();

        }

        break;

        case 'T':

        {

          String angle = "";

          T_flag = i;

          for(int i=P_flag+1;i<T_flag;i++)

          {

            angle += data[i];

          }

          data_array[1] = angle.toInt();

        }

        break;

        default: break;

      }     

    }

   

    /*

    Serial.println(B_flag);

    Serial.println(P_flag);

    Serial.println(T_flag);

   

    for(int i=0;i<2;i++)

    {

      Serial.println(data_array[i]);

    }

    */

   

    dataComplete = true;

  }

 

  if(dataComplete)

  {

    if(data_array[1] >= ANGLE_VALUE_MIN && data_array[1] <= ANGLE_VALUE_MAX)

    {

      tlc_setServo(data_array[0], data_array[1]);

    }

    else if(data_array[1] >= PWM_VALUE_MIN && data_array[1] <= PWM_VALUE_MAX)

    {

      data_array[1] = map(data_array[1], 500, 2500, 0, 180);

      tlc_setServo(data_array[0], data_array[1]);

    }

    Tlc.update();

    dataComplete = false;

  }

 


}

使用 Bigfish扩展板 调试舵机时,将Controller1.0b资料包\Arduino\servo_bigfish\servo_bigfish.ino下载到主控板。

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

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

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

/*

* Bigfish扩展板舵机口; 4, 7, 11, 3, 8, 12, 14, 15, 16, 17, 18, 19

* 使用软件调节舵机时请拖拽对应序号的控制块

*/

#include <Servo.h>


#define ANGLE_VALUE_MIN 0

#define ANGLE_VALUE_MAX 180

#define PWM_VALUE_MIN 500

#define PWM_VALUE_MAX 2500


#define SERVO_NUM 12


Servo myServo[SERVO_NUM];


int data_array[2] = {0,0};   //servo_pin: data_array[0], servo_value: data_array[1];

int servo_port[SERVO_NUM] = {4, 7, 11, 3, 8, 12, 14, 15, 16, 17, 18, 19};

int servo_value[SERVO_NUM] = {};


String data = "";


boolean dataComplete = false;


void setup() {

  Serial.begin(9600);

 

}


void loop() {

 

  while(Serial.available())

  {

    int B_flag, P_flag, T_flag;

    data = Serial.readStringUntil('\n');

    data.trim();

    for(int i=0;i<data.length();i++)

    {

      //Serial.println(data[i]);

      switch(data[i])

      {

        case '#':

          B_flag = i;  

        break;

        case 'P':

        {

          String pin = "";

          P_flag = i;

          for(int i=B_flag+1;i<P_flag;i++)

          {

            pin+=data[i];

          }

          data_array[0] = pin.toInt();

        }

        break;

        case 'T':

        {

          String angle = "";

          T_flag = i;

          for(int i=P_flag+1;i<T_flag;i++)

          {

            angle += data[i];

          }

          data_array[1] = angle.toInt();

          servo_value[pin2index(data_array[0])] = data_array[1];

        }

        break;

        default: break;

      }     

    }

   

    /*

    Serial.println(B_flag);

    Serial.println(P_flag);

    Serial.println(T_flag);

   

    for(int i=0;i<2;i++)

    {

      Serial.println(data_array[i]);

    }

    */

   

    dataComplete = true;

  }

 

  if(dataComplete)

  {

    for(int i=0;i<SERVO_NUM;i++)

    {

      ServoGo(i, servo_value[i]);

      /*********************************串口查看输出***********************************/

//      Serial.print(servo_value[i]);

//      Serial.print(" ");

    }

//    Serial.println();

      /*********************************++++++++++++***********************************/


    dataComplete = false;

  }

 


}


void ServoStart(int which){

  if(!myServo[which].attached() && (servo_value[which] != 0))myServo[which].attach(servo_port[which]);

      else return;

  pinMode(servo_port[which], OUTPUT);

}


void ServoStop(int which){

  myServo[which].detach();

  digitalWrite(servo_port[which],LOW);

}


void ServoGo(int which , int where){

  ServoStart(which);

  if(where >= ANGLE_VALUE_MIN && where <= ANGLE_VALUE_MAX)

  {

    myServo[which].write(where);

  }

  else if(where >= PWM_VALUE_MIN && where <= PWM_VALUE_MAX)

  {

    myServo[which].writeMicroseconds(where);

  }

}


int pin2index(int _pin){

  int index;

  switch(_pin)

  {

    case 4: index = 0; break;

    case 7: index = 1; break;

    case 11: index = 2; break;

    case 3: index = 3; break;

    case 8: index = 4; break;

    case 12: index = 5; break;

    case 14: index = 6; break;

    case 15: index = 7; break;

    case 16: index = 8; break;

    case 17: index = 9; break;

    case 18: index = 10; break;

    case 19: index = 11; break;

  }

  return index;

}

下载完成后,保持主控板和电脑的USB连接,并打开主控板电源,以便利用上位机进行调试。

② 双击打开Controller 1.0.exe:

 ③ 界面左上角选择:

设置-面板设置,弹出需要显示的调试块,可通过勾选隐藏不需要调试的舵机块:联机-选择主控板对应端口号以及波特率。

 ④ 拖动进度条,可以观察相应的舵机角度转动。写好对应的舵机调试角度,勾选左下角添加-转化,获得舵机调试的数组:

 ⑤ 该数组可直接复制到相应的arduino软件的程序中进行使用。

使用Controller 1.0b软件调试舵机角度的实验案例可参考 12自由度六足-原地舞蹈

4.资料下载

如何驱动模拟舵机-Controller1.0b资料包

资料内容详见:如何驱动模拟舵机

  • 1
    点赞
  • 0
    收藏
    觉得还不错? 一键收藏
  • 0
    评论
程序名称: 飞思卡尔智能车调试工具 v1.1 程序作者: LinX 时 间: 2009-03-07 联系方式: Q Q : 408111919 Email: linhaiwz@163.com" & vbCrLf & vbCrLf & _ 〖 本程序为方便调试而编写,错误在所难免,如有建议欢迎和我联系! 〗 角度转换为高电平时间 角度 -45 0 45 (anger/度) 高电平时间 1000 1500 2000 (t/us) 计算公式为:T = 1000 + (anger + 45) * (1000 / 90) 该程序可以通过串口与单片进行通讯,实时改变的角度。 通讯协议为:0xfe 0xMM 0xNN (其中0xfe为包头,0xMM为PWMDTYx高8位,0xN为PWMDTYx低8位) 在串口中断中分三次接收,在第二次接收时保存数据到temp0中,在第三次接收到数据时将PWMDTY01= ((unsigned int)temp0 <<8) | RxData 就可以完成PWM改变输出了。 下位程序如下: #include <hidef.h> /* common defines and macros */ #include <MC9S12XS128.h> /* derivative information */ #pragma LINK_INFO DERIVATIVE "mc9s12xs128" unsigned char RX=0,temp0; void uart_putchar(unsigned char ch) { if (ch == '\n') { while(!(SCI0SR1&0x80)) ; SCI0DRL= 0x0d; return; } while(!(SCI0SR1&0x80)) ; SCI0DRL=ch; } static void PWM_Init(void) { //SB,B for ch2367 //SA,A for ch0145 PWMCTL_CON01=1; //0和1联合成16位PWM; PWMCAE_CAE1=0; //选择输出模式为左对齐输出模式 PWMCNT01 = 0; //计数器清零; PWMPOL_PPOL1=1; //先输出高电平,计数到DTY时,反转电平 PWMPRCLK = 0X40; //clockA不分频,clockA=busclock=16MHz;CLK B 16分频:1Mhz PWMSCLA = 8; //对clock SA 进行2*8=16分频;pwm clock=clockA/16=1MHz; PWMCLK_PCLK1 = 1; //选择clock SA做时钟源 PWMPER01 = 20000; //周期20ms; 50Hz;(可以使用的范围:50-200hz) PWMDTY01 = 1500; //高电平时间为1.5ms; PWME_PWME1 = 1; } void setbusclock(void) //PLL setting { CLKSEL=0X00; //disengage PLL to system PLLCTL_PLLON=1; //turn on PLL SYNR=1; REFDV=1; //pllclock=2*osc*(1+SYNR)/(1+REFDV)=32MHz; _asm(nop); //BUS CLOCK=16M _asm(nop); while(!(CRGFLG_LOCK==1)); //when pll is steady ,then use it; CLKSEL_PLLSEL =1; //engage PLL to system; } static void SCI_Init(void) //SCI { SCI0CR1=0x00; SCI0CR2=0x2c; //enable Receive Full Interrupt,RX enable,Tx enable SCI0BDH=0x00; //busclk 8MHz,19200bps,SCI0BDL=0x1a SCI0BDL=0x68; //SCI0BDL=busclk/(16*SCI0BDL) //busclk 16MHz, 9600bps,SCI0BDL=0x68 } interrupt 20 void SCI_Rx_IRS(void) //中断接收 { unsigned char RxData; DisableInterrupts; if (SCI0SR1&0x20) { RxData = SCI0DRL; switch(RX) { case 0: if (RxData==0xfe) RX=1; break; case 1: temp0 = RxData; RX=2; break; case 2: PWMDTY01= ((unsigned int)temp0 <<8) | RxData; PORTB=~PORTB; RX=0; break; } uart_putchar(RxData); } EnableInterrupts; } void main(void) { EnableInterrupts; setbusclock(); SCI_Init(); PWM_Init(); DDRB=0xff; for(;;) { } }

“相关推荐”对你有帮助么?

  • 非常没帮助
  • 没帮助
  • 一般
  • 有帮助
  • 非常有帮助
提交
评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值