SHR8S调试说明书51系列.docx

1、SHR8S调试说明书51系列SHR-8S机械人调试说明书（51系列）研发部北京森汉科技一、SHR-8S人形机械人机体介绍1关于加藤一郎结构体早在1966年，日本早稻田大学的加藤一郎教授，即国际人形机械人之父就把人形机械人给定型了。头、躯干、四肢的防人结构和被学术界简化并给予必然数学方程式的数学模型已经注定的现时期的人形机械人的大体结构。如此做的益处是国际统一与各国之间的技术接轨。咱们适应的称其为“加藤一郎结构体”。如以下图分析：2全身机械结构原理人类在研究人体结构之前花费了大量的时刻去研究昆虫，哺乳动物的腿部移动，乃至登山运动员在登山时的腿部运动方式。这些研究帮忙咱们更好的了解在行走进程中发生

2、的一切，专门是关节处的运动。比如，咱们在行走的时候会移动咱们的重心，而且前后摆动双手来平稳咱们的躯体。这些组成了人形机械人行走的基础方式。人形机械人和人类一样，有髋关节，膝关节和足关节。机械人中的关节一样用“自由度”来表示。一个自由度表示一个运动能够或向上，或向下，或向右，或向左。分散在躯体的不同部位，因此骨骼结构因此而生。一样的，人形机械人身上装有两个传感器能辅助它水平行走，它们是加速度传感器和陀螺传感器。它们要紧用来让机械人明白躯体目前前进的速度和和地面所成的角度，并依次计算出平稳躯体所需要调剂量。这两个传感器起的作用和咱们人类内耳相同。要进行平稳的调剂，机械人还必需要有相应的关节传感器和

3、6轴的力传感器，来感知肢体角度和受力情形。机械人的行走中最重要的部份确实是它的调剂能力。因此需要检测在行走中产生的惯性力。当机械人行走时，它将受到由地球引力，和加速或减速行进所引发的惯性力的阻碍。这些力的总和被称之为总惯性力。当机械人的脚接触地面时，它将受到来自地面反作使劲的阻碍，那个力称之为地面反作使劲。所有这些力都必需要被平稳掉，而机械人的操纵目标确实是要找到一个姿势能够平稳掉所有的力。这称做zero moment point (ZMP)。当机械人维持最正确平稳状态的情形下行走时，轴向目标总惯性力与实际地面反作使劲相等。相应地，目标ZMP与地面反作使劲的中心点也重合。当机械人行走在不平坦的

4、地面时，轴向目标总惯性力与实际的地面反作使劲将会错位，因此会失去平稳，产生造成摔倒的力。摔倒力的大小与目标ZMP和地面反作使劲中心点的错位程度相对应。简而言之，目标ZMP和地面反作使劲中心点的错位是造成失去平稳的要紧缘故。假假设机械人失去平稳有可能摔倒时，下述三个操纵系统将起作用，以避免摔倒，并维持继续行走状态。（1）地面反作使劲操纵：脚底要能够适应地面的不平整，同时还要能稳固的站住。（2）目标ZMP操纵：当由于各类缘故造成机械人无法站立，并开始倾倒的时候，需要操纵他的上肢反方向运动来操纵即将产生的摔跤，同时还要加速步速来平稳躯体。（3）落脚点操纵：当目标ZMP操纵被激活的时候，机械人需要调剂

5、每步的间距来知足那时躯体的位置，速度和步长之间的关系。3制造工艺由于目前的国际化生产模式趋于完善，大多厂商的产业链条搭建结构重叠，再加上中国目前处于一个世界超级的外贸加工出口型国家，因此森汉科技生产的小型人形机械人与日本生产的小型人形机械人工艺水平十分接近。有的日本品牌的小型人形机械人也在中国生产，而且与森汉科技公司的生产线挨得很近。乃至有的零件采纳同一条生产线制造，因此共通性较强。如此的一个大环境下，致使森汉科技生产的小型人形机械人与日本品牌的小型人形机械人制造工艺十分相似。实际生产进程中，由模具制造先进行，然后再生产全数的零件。其中包括金属零件和塑料零件。SHR-8S人形机械人全身共需19

6、付模具完成零件生产。二、机械人电路板硬件基础除机械人机体本身之外，还有很重要的一个部份确实是机械人的操纵器系统。森汉科技生产的操纵板具有专门好的操作性。目前市面上利用最普遍的是51系列单片机，咱们的操纵板采纳STC12C5A60S2单片机，大部份元器件采纳全表贴工艺。此操纵板设计合理，扩展了STC12C5A60S2系列单片机的所有外接端口。1STC12C5A60S2操纵板实物图STC12C5A60S2操纵板电路板上面的要紧元件：CPU： STC12C5A60S2， 48pinLQFP封装，60KBFlash，内置2KBEEPROMEEPROM： 两片电可擦除存储芯片AT24C512，存储空间共

7、128KB，使机械人程序存储器空间扩充至190KB。欠压爱惜： 带欠压爱惜电路，系统供电低于6V时，系统将无穷制的复位，且爱惜电压可调。RS232接口：4pinRS232接口，带“CTS”判定位，可同时输出RS232电平和TTL电平。红外接收器：接收遥控器的红外信号，与用户进行信息交互；此接口同时能够做外部中断接收利用。蜂 鸣 器： 发出响声，与用户进行信息交互；IO口： 此电路板共扩展35个IO口，其中：24个专业舵机操纵口（），11个全能口； 注：全能接口能够选择或5V电压供电，上拉电阻或下拉电阻可选。可用于各类传感器和扩展舵机。编程接口： 采纳STC标准的串口ISP编程方式；2STC12

8、C5A60S2操纵板原理图此操纵板设计合理，功能壮大，操作简单。咱们为用户开发了底层程序，并做成子程序。通过简单了解以后，咱们就能够够编制自己的程序。那个地址需要强调几个注意：（1）电源的正负问题，一样情形下，红色线是正极，黑色线是负极，操纵板上正负极已经用“+”“ ”号标明。（2）舵机接线统一遵守标准：在操纵板上靠内侧即靠近单片机的一端是操纵信号线，中间是电源（一样是正端），最外面的是地（GND）。如以下图所示：三、SHR-8S人形机械人机体参数SHR-8S人形机械人是17自由度小型人形机械人。全身包括17个伺服电机（舵机）。每一个舵机扭矩为，全数采纳金属齿轮传动。四、机械人操纵端口概念由于

9、机械人的机械体与运算机系统相接，因此确信需要定端口协议。事实上，依照加藤一郎的结构划分，人形机械人分为3个坐标平面。1.机械人坐标平面的划分平面概念X平面（侧平面）舵机Y平面（面平面）舵机平面（顶平面）舵机2.机械人各坐标平面舵机的划分3.机械人各舵机与操纵口的概念 程序中命名 概念接口 平面命名 电路板接口 position0 x1舵机 J0 x轴 position1 x2舵机 J1 position2 x3舵机 J2 position3 x4舵机 J3 position4 x5舵机 J4 position5 x6舵机 J5 position6 x7舵机 J6 position7 x8舵机

10、J7 position8 y1舵机 J16 y轴 position9 y2舵机 J17 position10 y3舵机 J18 position11 y4舵机 J19 position12 y5舵机 J20 position13 y6舵机 J21 position14 y7舵机 J22 position15 y8舵机 J23 position16 z1舵机 J8 z轴 position17 position18 position19 position20 position21 position22 position23 4.机械人各舵机操纵散布五、舵机PWM信号介绍1PWM信号的概念PWM信号

11、为脉宽调制信号，其特点在于他的上升沿与下降沿之间的时刻宽度。具体的时刻宽窄协议参考以下讲述。咱们目前利用的舵机要紧依托于模型行业的标准协议，随着机械人行业的渐渐独立，有些厂商已经推出全新的舵机协议，这些舵机只能应用于机械人行业，已经不能够应用于传统的模型上面了。目前，北京森汉的SH14-M舵机采纳传统的PWM协议，优缺点一目了然。优势是已经产业化，本钱低，旋转角度大（目前所生产的都可达到185度）；缺点是操纵比较复杂。可是它是一款数字型的舵机，其对PWM信号的要求较低：（1）不用随时接收指令，减少CPU的疲劳程度；（2）能够位置自锁、位置跟踪，这方面超越了一般的步进电机；其PWM格式注意的几个

12、要点：（1）上升沿最少为，为之间；（2）SH14-M数字舵机下降沿时刻没要求，目前采纳就行；也确实是说PWM波形能够是一个周期1mS的标准方波；（3）SH0680为塑料齿轮模拟舵机，其要求持续供给PWM信号；它也能够输入一个周期为1mS的标准方波，这时表现出来的跟从性能专门好、很紧密。2PWM信号操纵精度制定1 DWT = 8uS ; 250DWT=2mS时基寄放器内的数值为：（#01H）01 （#0FAH）250。共185度，分为250个位置，每一个位置叫1DWT。那么：185250 = 度 / DWTPWM上升沿函数： + NDWT 0uS NDWT 2mS +NDWT 六、单舵机拖动及调

13、速算法1舵机为随动机构（1）当其未转到目标位置时，将全速向目标位置转动。（2）当其抵达目标位置时，将自动维持该位置。因此关于数字舵机而言，PWM信号提供的是目标位置，跟踪运动要靠舵机本身。（3）像SH-0680如此的模拟舵机需要时刻供给PWM信号，舵机自己不能锁定目标位置。因此咱们的操纵系统是一个目标计划系统。（1）SH14-M舵机的位置操纵方式舵机的转角达到185度，由于采纳8为CPU操纵，因此操纵精度最大为256份。目前通过实际测试和计划，分了250份。具体划分参见“PWM信号操纵精度制定”。将0185分为250份，每份度。操纵所需的PWM宽度为，宽度2ms。2ms250=8us；因此得出

14、：PWM信号高电平持续的时刻 =度数/8s + 500s；角度04590135185N062125187250PWM1ms2ms（2）SH14-M舵机的运动协议运动时可之外接较大的转动负载，舵机输出扭矩较大，而且抗抖动性专门好，电位器的线性度较高，达到极限位置时也可不能偏离目标。2目标计划系统的特点（1）舵机的跟随特性 舵机稳固在A点不动； CPU发出B点位置坐标的PWM信号； 舵机全速由A点转向B点； CPU发出B点PWM信号后，应该等待一段时刻，利用现在刻舵机才能转动至B点。那么，具体的维持（等待）时刻如何来计算，如下讲解：令：维持时刻为T 当TT时，舵性能够抵达目标，并有剩余时刻；当TT

15、时，舵机不能抵达目标；理论上：当T=T时，系统最连贯，而且舵机运动的最快。实际进程中由于2个因素： 1个机械人身上有多个舵机，负载个不相同，因此不同； 某个舵机在不同时刻的外界环境负载也不同，因此不同；那么连贯运动时的极限T难以计算出来。目前采取的方式是体会选取值。（2）舵机值测定舵机的值随时转变，因此只能测定一个平均值，或称显现概率最高的点。依据： 厂商的体会值； 采纳SH14-M具体进行测试；测试实验： 将CPU开通，并开始延时T； 当延时T抵达后，观看舵机是不是抵达目标；测按时采纳一段双摆程序，伴随示波器用肉眼观看T与T的关系。（3）舵机值计算一样舵机定为秒/60度；取秒/60度 秒/3

16、60度 秒/185度则为360度/秒，2/秒=300度/秒那么185度转动的时刻为185度360度*秒 = 秒。（4）采纳双摆实验验证3DWA的概念将185度的转角分为250个平均小份。那么：每小份为度。概念如下：DWA = 度由于： = 秒/60度那么：运行1 DWA所需时刻为：度*秒/60度 = mS；4DWT的概念舵机电路支持的PWM信号为，总距离为2mS。假设分为250小份，那么2mS250 = mS = 8uS概念如下：DWT = 8uS5单舵机调速算法测试内容：将后手下降沿的时刻拉至30ms没有问题，舵机照样工作。将后手下降沿的时刻拉至10ms没有问题，舵机照样工作。 将后手下降沿

17、的时刻拉至没有问题，舵机照样工作。 将后手下降沿的时刻拉至500us没有问题，舵机照样工作。实践查验出：下降沿时刻参数能够做的很小。目前实验降至500uS，仍然工作正常。缘故是：（1）舵机电路自动检测上升沿，遇上升沿就触发，以此监测PWM脉宽“头”。 （2）舵机电路自动检测下降沿，遇下降沿就触发，以此监测PWM脉宽“尾”。（1）舵机转动时的极限下降沿PWM脉宽T：舵机运转1DWA（度）所需要的最小时刻，目前计算出的数值为；T前面的20 mS等待时刻能够省略，舵机仍然工作；而且得出舵机跟从的最快驱动方式。舵机T数据实验表格T值舵机运转特性T与T关系该程序可行度备注500us不能跟随T T不可行8

18、00us不能跟随T T不可行1ms不能跟随T T可行最快、平滑跟随T T可行最快、平滑2ms跟随T T可行最快、平滑跟随T T可行最快、平滑10ms跟随T T可行较慢、平滑20ms跟随T T可行较慢、平滑30ms跟随T T可行较慢、平滑40ms跟随T T可以较慢、微抖50ms跟随T T可以很慢、微抖70ms跟随T T不可以很慢、较抖100ms跟随T T不可以很慢、较抖令人质疑的地址为时的表现，得出的T T；也确实是说 = ，显然存在问题。通过考虑从头观看PWM波形图发觉，电机真正的启动点如以下图： 事实上由A到B的运动时刻为：T = T +（B点的）PWM ？七、8舵机联动单周期PWM指令算法

19、1操纵要求要求同时发给8个舵机位置目标值，该指令的执行周期尽可能短，目的有2个：其一，是为了以后扩充至24舵机；其二，目标越快，舵机的转动速度越快；咱们以8路为1组或称1个单位，持续发出目标位置，形成持续的目标计划曲线，电机在跟从进程中自然形成了位置与速度的双指标曲线，实现8路舵机联动。2注意事项从24个端口，P0、P1到P2，单DWT循环的最小时刻只有8us，因此串行运算是不行的，那么就采纳并行运算。目前采纳的并行算法是为一个大体单位，8位一并。实际案例：P0口的8个位置各不相同；例如：端口N寄存器目标位置（度）N数值（整数）PWM宽度（ms）position000position11pos

20、ition210position33750position474100position5111150position6148200position7185250T为一个周期，分为2部分1PWM宽2延时等待38路PWM信号发生算法解析概念数组：arr8; pick_up8; 例如：arr01234567备注1206089201220136102pick_up012345670xFE0xFD0xFB0xF70xEF0xDF0xBF0x7Farr8内为P0口的8路N数值，这些数值是依照舵机状态定的，没有规律。pick_up8内为固定的一组逻辑参数。将数组arr内的数据由大到小排列，pick_up内的

21、数据也数之转变，变成：arr01234567备注2011201028960362012pick_up765432100xDF 0xFE 0x7F 0xFB 0xFD0xBF0xF70xEF将N值做减法，求得：arr0=arr0-arr1=81 arr1=arr1-arr2=18 arr2=arr2-arr3=13 arr3=arr3-arr4=29 arr4=arr4-arr5=24 arr5=arr5-arr6=16 arr6=arr6-arr7=8 arr7=arr7=12咱们将每8路输出的高电平常刻限制在一个的中断内，开启中断。将全数的8路输出置为高电平，并延时500ms作为目标位置为0

22、的基础。循环8次,每次延时arr内的值个8us,再将P0口“与” 相应的逻辑参数，例如：N差值延时时间（N差值*8us）对应“与”的值相应输出0的位相继变成低电平的顺序arr71296us0xEF（0B）第四位置“0”4arr6864us0XF7（0B）第三位置“0”3arr516128us0xBF（0B）第六位置“0”6arr424192us0xFD（0B）第一位置“0”1arr329232us0xFB（0B）第二位置“0”2arr213104us0x7F（0B01111111）第七位置“0”7arr118144us0xFE（0B）第零位置“0”0arr081648us0xDF（0B）第五位

23、置“0”5 最终输出顺序如以下图所示：Tw424路单周期子程序EX”INTEL 二进制文件。有了那个文件，咱们才能利用STC提供的软件进行烧写单片机的操作。（1）.在KEIL C下成立工程（project）在“project”菜单下选择“New project”，这时会有对话框询问你将工程保留在什么目录下，并询问工程名称，那个名称将使系统相关的文件都已那个名字为开头，包括咱们将要用到HEX文件。如下图：（2）.选择开发芯片类型在设置好文件名和目录以后，系统会询问你所利用的芯片类型。咱们那个地址只利用标准的Intel8052AH即可。以下图是咱们的选择。点击“确信”完成工程向导。（3）.添加程序

24、文件到工程将制作好的C程序加入到新的工程中去。咱们能够在以下图中的对应位置，点击右键并左键点击对应选项添加文件。（4）.设置工程属性每一个工程的要求不一样，在KEIL C中为这些属性做了一个属性选项。咱们能够设置好工程属性以方便开发。第一在“project”菜单下选择“options for Filexxxxx”。如以下图所示：以后就会弹出工程属性对话框，在第三页“Output”选项卡下，将生成HEX文件的选项打上对勾，如以下图所示：点击确信完成工程属性的调整，如此咱们在以后生成的进程中就会生成HEX文件。关于下面的烧录软件来讲，需要的确实是HEX文件。咱们能够选择完全编译，在系统信息区看看是

25、不是生成了HEX文件。如以下图所示；如此咱们就能够够利用工程中的HEX文件通过STC 烧录软件烧录STC12C5A60S2了。 是由STC开发的程序烧写测试综合软件。它能够通过一般的串口（COM）烧写单片机的程序。软件运行稳固。操作相对方便。软件的操作界面如下：下面给出操作的具体步骤：1.选择芯片类型；2.选择要烧写的HEX文件；3.设置串行端口和波特率，那个地址要注意端口号，依如实际连接的串口选择。波特率的选择一样为默许的115200；4.选择外部晶振；仍为RESET；YES；High；与下载无关；NO；5.RESET2脚低于复位，选YES；6.点击下载按钮后，打开单片机供电电源。在上电后单

26、片机遇自动进入编程状态。通过提示能够判定是不是下载完成。7.此两项选中时表示每次下载时选择的都是打开文件的最新更新结果，及每次打开的hex文件发生改变时，软件自动执行下载命令。注意：1.在选择芯片时必然要看清型号，很容易选错。2.应选择外部晶振，若是选择内部晶振，单片能够工作，可是舵机的操纵会显现问题。3.必然要先点编程按钮，然后在开操纵板上的电源，不然下载就会失败。十二、注意事项1调试注意事项（1）在调试进程中，舵机不要长时刻处在被机械结构阻挡的情形下，也确实是说，若是舵机不能达到给定的角度值，是因为被机械结构阻挡了，那么现在舵机通电的时刻不要太长，最多20秒，不然舵机内部的芯片就会烧掉了，舵机就会“冒烟”而且发烫。若是在调试进程中不能在20秒内完成全数下载进程，最好讲那个舵机的插口从电路板上拔下，下载完毕以后，再插上舵机插口，若是仍是有问题，应该再次拔掉，再次改程序，直到舵机的角度在能够达到的机械范围内为止。（2）若是舵机被烧坏，换舵机时，只要将新舵机的后盖打开，将黒、红、白三条线从电路板焊下来，坏掉的舵机一样如此，换上新舵机以后，直接把三条线焊到新舵机的电路板上就能够够了。焊线进程中要注意，不要短路。若是关于在如此小的电路板上焊接没有信心，能够将三条线在临近舵机时把线剪断，直接焊三条线的连接就能够够了。2其它注意事项（1）关于电池充电问