CN112603205B - 一种机器人行走速度调节方法 - Google Patents
一种机器人行走速度调节方法 Download PDFInfo
- Publication number
- CN112603205B CN112603205B CN202011491533.6A CN202011491533A CN112603205B CN 112603205 B CN112603205 B CN 112603205B CN 202011491533 A CN202011491533 A CN 202011491533A CN 112603205 B CN112603205 B CN 112603205B
- Authority
- CN
- China
- Prior art keywords
- speed
- robot
- current
- driving wheel
- adjustment
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
Images
Classifications
-
- A—HUMAN NECESSITIES
- A47—FURNITURE; DOMESTIC ARTICLES OR APPLIANCES; COFFEE MILLS; SPICE MILLS; SUCTION CLEANERS IN GENERAL
- A47L—DOMESTIC WASHING OR CLEANING; SUCTION CLEANERS IN GENERAL
- A47L11/00—Machines for cleaning floors, carpets, furniture, walls, or wall coverings
- A47L11/24—Floor-sweeping machines, motor-driven
-
- A—HUMAN NECESSITIES
- A47—FURNITURE; DOMESTIC ARTICLES OR APPLIANCES; COFFEE MILLS; SPICE MILLS; SUCTION CLEANERS IN GENERAL
- A47L—DOMESTIC WASHING OR CLEANING; SUCTION CLEANERS IN GENERAL
- A47L11/00—Machines for cleaning floors, carpets, furniture, walls, or wall coverings
- A47L11/40—Parts or details of machines not provided for in groups A47L11/02 - A47L11/38, or not restricted to one of these groups, e.g. handles, arrangements of switches, skirts, buffers, levers
- A47L11/4011—Regulation of the cleaning machine by electric means; Control systems and remote control systems therefor
Landscapes
- Manipulator (AREA)
Abstract
本发明公开一种机器人行走速度调节方法,该机器人行走速度调节方法是:基于机器人的驱动轮的行走速度的大小变化情况,利用P调节、增量式PI调节去周期性地控制机器人的驱动轮的行走速度平稳过渡到所述最终目标速度,并及时切换到不同的运动行走状态下,但不考虑速度方向因素和速度变化量方向的因素,实现在各种速度变化场景下能够让机器人的行走速度稳定地达到预先配置的目标速度,提高机器人行走的顺畅程度和运动行为切换的稳定性。
Description
技术领域
本发明涉及机器人的驱动轮控制技术领域,特别是一种机器人行走速度调节方法。
背景技术
目前扫地机器人在运动过程中速度控制存在一定的缺陷,例如,在机器人行走过程中,由于速度变化比较单一,如果响应太快,在运动行为切换时存在顿挫感,反应太慢,就会迟顿,并且实际值没达到目标值就有可能因为速度大小的因素而切换到其他行为了,导致运动速度控制不够稳定。
发明内容
为了解决驱动轮速度调节变化时不稳定的问题,本发明结合P调节、增量式PI调节以及开环调节的方式来周期性地调控机器人的实时速度大小,以减少顿挫感,公开以下具体的技术方案:
一种机器人行走速度调节方法,包括:步骤1、根据所述驱动轮所处的运动行走状态,确定对机器人的驱动轮的当前行走速度进行P调节的方式;然后进入步骤2;其中,所述驱动轮所处的运动行走状态是与机器人当前执行的运动行为相关联的;步骤2、根据前述步骤1调节的当前行走速度与当前调节周期下配置的目标速度的大小关系,确定对前述步骤1调节的当前行走速度进行增量式PI调节的方式,以缩小当前行走速度与当前调节周期下配置的目标速度的速度差;然后进入步骤3;步骤3、判断是否完成预先配置的最终目标速度匹配的最后一个调节周期内的速度调节步骤,是则进入步骤4,否则将当前调节周期下配置的目标速度更新为下一调节周期下配置的目标速度,再返回步骤1;其中,这个预先配置的最终目标速度是与机器人的驱动轮所处的不同的运动行走状态是相关联的;步骤4、判断所述驱动轮所处的运动行走状态是否发生改变,是则返回步骤1,否则返回步骤2以维持执行所述增量式PI调节。
与现有技术相比,本技术方案基于机器人的驱动轮的行走速度的大小变化情况,利用P调节、增量式PI调节去周期性地控制机器人的驱动轮的行走速度平稳过渡到所述最终目标速度,并及时切换到不同的运动行走状态下,但不考虑速度方向因素和速度变化量方向的因素,实现在各种速度变化场景下能够让机器人的行走速度稳定地达到预先配置的目标速度,提高机器人行走的顺畅程度和运动行为切换的稳定性。
进一步地,还包括:在机器人启动运行时,分别对左驱动轮和机器人的右驱动轮配置相匹配的初始PWM信号占空比;其中,所述驱动轮包括左驱动轮和右驱动轮;然后根据所述驱动轮所处的运动行走状态,确定对机器人的驱动轮的当前行走速度进行P调节的方式。该技术方案提高所述驱动轮按照PWM信号占空比行走的响应速度,减少机器人在实际启动(包括启动加速运动、启动减速运动和启动刹车)所需调节的时间。
进一步地,所述根据所述驱动轮所处的运动行走状态,确定对机器人的驱动轮的当前行走速度进行P调节的方式的方法包括:当机器人的驱动轮在当前调节周期内切换到执行加速运动时,对机器人的驱动轮的当前行走速度与当前调节周期内配置的目标速度的速度差值进行P调节,使得P调节更新所述驱动轮的当前行走速度,以缩小所述驱动轮的当前行走速度与当前调节周期内配置的目标速度的速度差;其中,所述驱动轮所处的运动行走状态切换到加速运动。本技术方案在机器人切换到加速运动后,通过P调节来让所述驱动轮的当前行走速度快速响应更新,增强机器人对行走环境的敏感程度。
进一步地,所述根据所述驱动轮所处的运动行走状态,确定对机器人的驱动轮的当前行走速度进行P调节的方式的方法包括:当机器人的驱动轮在当前调节周期内切换到执行减速运动时,判断机器人的驱动轮的当前行走速度与当前调节周期内配置的目标速度的速度差值是否大于刹车速度差阈值,是则将所述驱动轮当前获得的PWM信号占空比反向处理以更新机器人的驱动轮的当前行走速度,使得机器人的驱动轮的当前行走速度与当前调节周期内配置的目标速度的速度差得到缩小;否则对机器人的驱动轮的当前行走速度进行P调节以更新所述驱动轮的当前行走速度,使得机器人的驱动轮的行走速度与当前调节周期内配置的目标速度的速度差得到缩小;或者,当机器人的驱动轮在当前调节周期内切换到执行减速运动时,判断当前调节周期内配置的目标速度是否为0,是则将所述驱动轮当前获得的PWM信号占空比反向处理以更新机器人的驱动轮的当前行走速度,使得机器人的驱动轮的行走速度与当前调节周期内配置的目标速度的速度差得到缩小;否则对机器人的驱动轮的当前行走速度进行P调节以更新所述驱动轮的当前行走速度,使得机器人的驱动轮的行走速度与当前调节周期内配置的目标速度的速度差得到缩小;其中,所述驱动轮所处的运动行走状态切换到减速运动。该技术方案切换到急减速变化的场合下,根据当前调节周期下配置的目标速度的大小选择性地使用P调节或反向处理PWM信号占空比,使驱动轮的行走速度更快达到的目标制动速度。
进一步地,所述反向处理包括:将所述驱动轮当前获得的PWM信号占空比直接设置更新为用于减速的刹车信号占空比,以获得反向处理输出的占空比信号;其中,这个反向处理输出的占空比信号用于供P调节和/或增量式PI调节使用;用于减速的刹车信号占空比所指示的速度变化量方向与机器人的驱动轮的当前行走速度的方向是相反的。该技术方案在机器人急需减速时,直接对PWM信号占空比取反处理而不需理会上一个调节周期内最新获得的PWM信号占空比的数值大小,从而降低机器人的驱动轮的当前行走速度,进而使得机器人的驱动轮的行走速度与当前调节周期内配置的目标速度的速度差得到缩小。
进一步地,所述P调节的方法包括:将机器人的驱动轮的当前行走速度与所述当前调节周期下配置的目标速度的速度差值与比例系数的乘积与所述驱动轮最新获得的PWM信号占空比相加,以获得P调节输出的PWM信号占空比,其中,P调节输出的PWM信号占空比用于更新机器人的驱动轮的当前行走速度。在该技术方案中,仅使用P调节的方式去改变更新驱动轮的当前行走速度,从而加快PWM信号占空比调节的响应速度。
进一步地,所述根据前述步骤1调节的当前行走速度与当前调节周期下配置的目标速度的大小关系,确定对前述步骤1调节的当前行走速度进行增量式PI调节的方式的方法包括:判断经过所述P调节更新后的当前行走速度与当前调节周期下配置的目标速度的速度差值的绝对值是否缩小为系统允许误差,是则对最新调节过的机器人的驱动轮的PWM信号占空比、更新后的当前行走速度与所述当前调节周期下配置的目标速度的速度差值与比例系数的乘积、更新后的当前行走速度与所述当前调节周期下配置的目标速度的速度差值与积分系数的乘积相加求和,以获得增量式PI调节输出的占空比;否则将最新调节过的机器人的驱动轮的PWM信号占空比输出以供下一调节周期的P调节、增量式PI调节或低速开环调节使用;其中,所述系统允许误差是100tick/s,这个tick/s是用于码盘表示的速度单位。
与现有技术相比,该技术方案在机器人的驱动轮的行走速度的变化过快(包括P调节过快)并接近当前调节周期下配置的目标速度时,把速度调节状态(前述反向处理或P调节)地切换为增量式PI调节状态,进入一种平稳的PI调节状态下进行速度的调节,能够有效地减少机器人的驱动轮行走过程中产生的顿挫感,并有效地减少静差,适应短时间的变化而不受过去的速度误差的影响。
进一步地,在对机器人的驱动轮的当前行走速度进行增量式PI调节之前,还包括:当更新后的当前行走速度与当前调节周期下配置的目标速度的速度差值的绝对值是缩小为所述系统允许误差时,判断当前调节周期下配置的目标速度是否小于所述驱动轮的码盘被允许读取的最低速度值,是则将最新调节过的机器人的驱动轮的PWM信号占空比更新为当前调节周期下配置的目标速度与一个低速开环系数的乘积,以实现低速开环调节更新最新更新获得的当前行走速度;否则使用前述的增量式PI调节,去继续调节更新最新更新获得的当前行走速度。与现有技术相比,本技术方案使用开环控制的方式解决码盘读数量程不够精准的问题,保证机器人能在低速调节的条件下根据码盘的读数正常行走。
进一步地,若当前调节周期下配置的目标速度小于所述驱动轮的码盘被允许读取的最低速度值,则选择将经过所述低速开环调节更新的PWM信号占空比直接输出至所述驱动轮对应的系统驱动层;若当前调节周期下配置的目标速度大于或等于所述驱动轮的码盘被允许读取的最低速度值,则选择将经过所述增量式PI调节更新的PWM信号占空比直接输出至所述驱动轮对应的系统驱动层;若经过所述P调节更新的行走速度与对应调节周期下配置的目标速度的速度差值的绝对值不是缩小为所述系统允许误差,则将经过同一P调节更新的PWM信号占空比直接输出至所述驱动轮对应的系统驱动层。以实现对机器人的驱动轮的行走速度的控制。
进一步地,在每一个调节周期内,所述目标速度是按照预先配置的固定的预期加速度计算得到的;其中,在配置的最后一个调节周期内,所述目标速度按照预先配置的固定的预期加速度计算获得所述最终目标速度。实现:根据固定的预期加速度把最终目标速度划分成每个调节周期内对应的目标速度,实现速度变化快慢的控制,进而结合前述技术方案在需要低速控制的场景下能柔和的控制机器行走,在需要速度快速变化的场合下能快速的响应使当前行走速度更快达到目标值。
附图说明
图1是本发明实施例提供一种机器人行走速度调节方法的流程图。
图2是加速运动的实施场景中提供一种机器人行走速度调节方法的流程图。
图3是刹车减速的实施场景中提供一种机器人行走速度调节方法的流程图。
具体实施方式
下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行详细描述。
作为一种实施例,本发明实施例公开一种基于方向的机器人行走速度调节方法,并由机器人内部设置的PID控制器控制驱动轮执行。如图1所示,具体包括:步骤S101、根据所述驱动轮所处的运动行走状态,确定对机器人的驱动轮的当前行走速度进行P调节的方式,以缩小当前行走速度与当前调节周期下配置的目标速度的速度差;然后进入步骤S102。在步骤S101中,机器人接收到预先配置的固定的预期加速度、用于调节速度的调节周期,然后机器人按照这个固定的预期加速度和调节周期计算出每一个调节周期所预期的目标速度,以此作为对应调节周期下的速度调节的依据,也是当前接收到的一个运动行为的控制指令所包含的速度信息。其中,所述驱动轮所处的运动行走状态是与机器人当前执行的运动行为相关联的;机器人执行的运动行走状态不同,则选择达到的最终目标速度也是不同的,比如油门启动模式下的最终目标速度(非0的速度)和刹车减速模式下的最终目标速度(最终目标速度在0的附近)是不同的,因此本实施例需要根据所述驱动轮所处的速度状态(油门启动模式和刹车减速模式下)选择是否对机器人的驱动轮的当前行走速度执行P调节,可以是在油门启动模式下执行P调节,但在刹车减速模式选择执行P调节和开环调节。需要说明的是,所述驱动轮所处的运动行走状态包括油门启动模式下的加速运动状态(加速度为正)和刹车减速模式下的减速运动状态(加速度为负)。
步骤S102、根据步骤S101调节的机器人的驱动轮的当前行走速度与当前调节周期下配置的目标速度的大小关系,确定对机器人的驱动轮的当前行走速度进行增量式PI调节的方式(包括执行增量式PI调节和不执行增量式PI调节以便于在下一调节周期经历新的一次P调节后再判断是否执行),以在步骤S101调节基础上继续缩小当前行走速度与当前调节周期下配置的目标速度的速度差;也获取机器人的驱动轮在当前调节周期内所需达到的PWM信号占空比,较为稳定地补偿步骤S102调节过的当前行走速度与当前调节周期下配置的目标速度的速度差。具体地,本实施例采用增量式PI调节对驱动轮的当前行走速度进行调节,以补偿当前行走速度与当前调节周期下配置的目标速度的速度差,特别是机器人的驱动轮的行走速度与当前调节周期下配置的目标速度的速度差是缩小为系统允许误差,即机器人的驱动轮的行走速度接近当前调节周期下配置的目标速度时,机器人切换到平稳的增量式PI调节,当速度差越大,当前调节周期下的增量式PI调节的补偿量越大,以便于稳定地将机器人的驱动轮的行走速度往逼近当前调节周期下配置的目标速度调节,相对于PID调节,本实施例在机器人的驱动轮的当前行走速度比较接近当前调节周期下配置的目标速度的情况下没有引入微分调节环节,因为微分调节环节会延长调节时间,对整个PID调节的速度响应的改善优化作用有限,而且微分调节环节相对于PI调节环节更容易收到细微噪声的影响。因此,本实施例通过增量式PI调节更能实现短时间的变化而不受过去的影响,保证机器人的调速系统的稳定性。
在本实施例中,机器人的驱动轮的行走速度(当前的或调节更新后的)与当前调节周期下配置的目标速度的速度差一直保持缩小状态。
另外,若判断到前述步骤S101调节的当前行走速度与当前调节周期下配置的目标速度的速度差不是缩小为系统允许误差、且不是所述最终目标速度对应的最后一个调节周期时,可以进入下一调节周期继续新的一次速度调节,实现稳定地将机器人的驱动轮的行走速度拉近至所述最终目标速度。
需要说明的是,在本实施例中,机器人的驱动轮的当前行走速度与当前调节周期下配置的目标速度的速度差不是缩小为系统允许误差时,在机器人的驱动轮的行走速度与当前调节周期下配置的目标速度不是比较接近的情况下,不进入增量式PI调节,因为本实施例公开的增量式PI调节是用于机器人的驱动轮的当前行走速度与当前调节周期下配置的目标速度的速度差比较小的情况下进行平稳的调节的,有利于消除静差和克服部分噪声的干扰。
步骤S103、判断是否完成预先配置的最终目标速度匹配的最后一个调节周期内的速度调节步骤(最后一个调节周期内执行前述步骤S101和前述步骤S102),是则进入步骤S105,否。则进入步骤S104。其中,这个预先配置的最终目标速度是机器人的驱动轮所处的运动行走状态是相关联的,当机器人的驱动轮处于加速状态时,这个预先配置的最终目标速度是比机器人的驱动轮在加速运动中的初始速度大的;当机器人的驱动轮处于刹车减速状态时,这个预先配置的最终目标速度是比机器人的驱动轮在刹车减速运动中的初始速度小的,在急刹车减速状态是接近0的。
因此,前述步骤通过分周期调节机器人的驱动轮的当前行走速度依次达到对应的目标速度,减少机器人行走过程中的顿挫感。因而,实现:根据固定的预期加速度把最终目标速度划分成每个调节周期内对应的目标速度,实现速度变化快慢的控制。需要说明的是,在每一个调节周期内,所述目标速度是按照预先配置的固定的预期加速度计算得到的;其中,调节周期的个数是由所述最终目标速度、预先配置的固定的预期加速度和调节周期的周期长度计算获得。具体地,首先求取预先配置的固定的预期加速度和调节周期的周期长度的乘积,作为调节周期内的固定速度变化量;然后求取所述最终目标速度与这个固定速度变化量的比值,作为所述调节周期的个数。
步骤S105、判断所述驱动轮的运动行走状态是否发生改变,是则返回步骤S101,否则返回步骤S102。当机器人接收到下一个不同类型的运动行为的最终目标速度的控制指令时,机器人的驱动轮所处的运动行走状态发生改变,可能是由加速运动切换到减速运动,也可以是由减速运动切换为加速运动,此时需重新执行前述的PID调节以确保在新的运动行走状态下达到对应的新的目标速度,保证加减速切换过程中的变速无顿挫,进而减少机器人行走过程中的顿挫感,也实现对速度的精准控制。当机器人没有接收到下一个不同类型的运动行为的最终目标速度的控制指令时,返回步骤S102维持前述的增量式PI调节,尽管在最后一个调节周期内,上一个调节周期调节更新的机器人的驱动轮的行走速度已经接近所述最终目标速度,但是还是存在干扰、静差等因素,仍需保持PID调节以维持稳定的速度状态,具体是返回步骤S102继续保持增量式PI调节,而不用理会调节周期或者是调节时间的长短问题。避免当前运动行为下的运动行走状态出现过多的静差,并对扰动合理调节,保证机器人在当前运动状态下的稳定性。
步骤S104、将当前调节周期下配置的目标速度更新为下一调节周期下配置的目标速度,然后返回步骤S101。在步骤S104中,机器人的驱动轮在当前调节周期下的当前行走速度是被增量式PI调节更新为新的行走速度,用于在下一调节周期内与下一调节周期下配置的目标速度进行比较以完成新的增量式PI调节;当然机器人的驱动轮在当前调节周期下的当前行走速度也可以是没有被增量式PI调节更新过的,需要在下一调节周期内与下一调节周期下配置的目标速度进行比较,判断是否可以通过增量式PI调节来稳定地补偿机器人的行走速度与下一调节周期下配置的目标速度的速度差,以实现调节后的行走速度稳定地接近于下一调节周期下配置的目标速度、或落入下一调节周期下配置的目标速度的临界误差范围内,并保证这一过程中产生的静差得以消除,产生的噪声干扰也得到合理的调节。需要说明的是,在每一个调节周期内,所述目标速度是按照预先配置的固定的预期加速度计算得到的,下一调节周期下配置的目标速度可以是比当前调节周期下配置的目标速度大;根据步骤S101中确定的运动行走状态的不同可以决定下一调节周期下配置的目标速度是比当前调节周期下配置的目标速度小。
需要说明的是,在重复上述步骤S101至步骤S105的过程中,无论切换到哪一种运动行走状态下,本实施例进行增量式PI调节后将当前调节周期下达到的PWM信号占空比更新为下一调节周期下所需达到的PWM信号占空比,用于控制机器人的驱动轮的行走速度发生变化(比如加速和减速),因为增量式PI调节实际上是基于机器人的驱动轮的行走速度与当前调节周期下配置的目标速度的速度差,配置比例系数和积分系数进行乘积求和运算得到占空比信号。当然机器人输出的PWM信号占空比用于控制改变驱动轮的速度变化量。其中,PWM信号占空比采用的是1024级控制占空比,使得速度的处理更加的精细。
在本实施例中,机器人的驱动轮的当前行走速度以及调节后的行走速度都是由机器人的驱动轮内部的码盘读取换算出来的。机器人是通过码盘取获取当前速度的,所以在对所述目标速度做处理之前需要把所述目标速度按照码盘比进行单位的转换,把速度的单位mm/s转换为tick/s,同理对预期加速度的单位作为相应的调整变化,其中,码盘比在是客户端根据机器人的实际运动速度情况配置的;同时,驱动轮的调节周期优选为10ms,作为机器人的运动控制周期,对应测试读取显示出来的机器人实际运动速度也是比较流畅的。
与现有技术相比,本实施例基于机器人的驱动轮的行走速度的大小变化情况,利用P调节、增量式PI调节去周期性地控制机器人的驱动轮的行走速度平稳过渡到所述最终目标速度,并及时切换到不同的运动行走状态下,但不考虑速度方向因素和速度变化量方向的因素,实现在各种速度变化场景下能够让机器人的行走速度稳定地达到预先配置的目标速度,提高机器人行走的顺畅程度和运动行为切换的稳定性。
作为另一种实施例,即加速运动的实施场景中,或者是从原来的减速运动的场景切换到加速运动的实施场景时,提供一种机器人行走速度调节方法,具体如图2所示,具体包括以下步骤:
步骤S201、在机器人启动运动时,对驱动轮配置初始PWM信号占空比、最终目标速度、固定的预期加速度和调节周期,此时机器人按照这个固定的预期加速度和调节周期计算出每一个调节周期所预期的目标速度,以此作为对应调节周期下执行PID调节的判断依据,表明机器人当前的运动行为不是处于刹车减速模式下,加速度方向、速度变化量的方向不会发生改变;然后进入步骤S202。具体地,在机器人启动加速运动时,分别对左驱动轮和机器人的右驱动轮配置相匹配的初始PWM信号占空比;其中,所述驱动轮包括左驱动轮和右驱动轮;该步骤为防止机器人开始启动时会扭动,则从0状态启动时直接给驱动轮输送默认的占空比,既可以减少在启动时P调节的时间,又确保了左驱动轮和右驱动轮的一致性。
需要说明的是,左右驱动轮内的码盘单位采样时间内的实时脉冲计数可以得出实时左右驱动轮的速度值,左右驱动轮的脉冲计数,经过码盘计算与速度的转换公式(该转换公式可为本领域人员常用技术,也可为本申请人研究出的成果)得到机器人在当前运动行为下的整体速度,该整体速度为左右驱动轮的平均值)。
步骤S202、根据驱动轮的码盘读数确定出机器人的运动状态,包括加速运动和慢减速运动(反向加速运动,但减速不过头以至于反向超过原始速度)。然后进入步骤S203。此时,机器人可能是启动油门,开始加速运动。
步骤S203、当机器人的驱动轮按照当前调节周期内调节出的速度变化量进行加速运动时,对机器人的驱动轮的当前行走速度与当前调节周期内配置的目标速度的速度差值进行P调节,让P调节输出的PWM信号占空比换算更新所述驱动轮的当前行走速度,以缩小驱动轮的行走速度与当前调节周期内配置的目标速度的速度差。然后进入步骤S204。具体地,步骤S203在机器人执行加速运动的过程中,通过P调节来让所述驱动轮的当前行走速度快速响应更新,增强机器人对行走环境的敏感程度,防止超调和振荡。从而在机器人刚启动加速这一低速控制的场景下能柔和的控制机器行走。因此,本实施例实现根据所述驱动轮所处的速度状态,确定对机器人的驱动轮的当前行走速度进行P调节,提高所述驱动轮按照PWM信号占空比行走的响应速度,减少机器人在实际启动(包括启动加速运动)所需调节的时间。
需要说明的是,所述P调节的方法包括:将机器人的驱动轮在当前调节周期内更新前的当前行走速度与所述当前调节周期下配置的目标速度的速度差值与比例系数的乘积与所述驱动轮最新获得的PWM信号占空比相加,以获得P调节输出的PWM信号占空比,其中,P调节输出的PWM信号占空比用于控制更新机器人的驱动轮的当前行走速度。本实施例仅使用P调节的方式去改变更新驱动轮的当前行走速度,从而加快PWM信号占空比调节的响应速度。
步骤S204、判断步骤S203更新后的当前行走速度与当前调节周期下配置的目标速度的速度差值的绝对值是否为缩小为所述系统允许误差,是则进入步骤S205,即步骤S203更新后的当前行走速度接近当前调节周期下配置的目标速度时进入步骤S205,否则进入步骤S208。优选地,所述系统允许误差用于表示所述当前行走速度在经过所述P调节后,当前行走速度接近当前调节周期下配置的目标速度。所述系统允许误差优选为100tick/s。
因此通过设置所述系统允许误差来检测并触发调节减速过头的驱动轮的行走速度、以及加速过大的驱动轮的行走速度,避免步骤S203更新后的当前行走速度与当前调节周期下配置的目标速度的速度差值变得过大,进而及时防止后续增量式PI调节出的PWM信号占空比失控、以及下一调节周期内的P调节输出的PWM信号占空比失控。
步骤S205、判断当前调节周期下配置的目标速度是否小于所述驱动轮的码盘被读取的最低速度值,是则进入步骤S207,否则进入步骤S206。
步骤S207、将最新调节过的机器人的驱动轮的PWM信号占空比(步骤S203调节更新过的)更新为当前调节周期下配置的目标速度与一个低速开环系数的乘积,以实现低速开环调节步骤S203调节更新过的PWM信号占空比,间接控制更新经过所述P调节更新后的当前行走速度,使用开环控制的方式解决码盘读数量程不够精准的问题,可以是按照低速开环系数增大所述目标速度,使得与当前调节周期下配置的目标速度的速度差值的绝对值是缩小为所述系统允许误差的当前行走速度能够在码盘上被正常读取,保证机器人在刚启动加速的场景下的速度数据能被码盘读取,并根据对应的读数正常行走。然后进入步骤S208。
步骤S206、使用增量式PI调节的方式,去调节更新步骤S203更新过的当前行走速度,从而实现:根据机器人的驱动轮的当前行走速度与当前调节周期下配置的目标速度的大小关系,对机器人的驱动轮的当前行走速度进行增量式PI调节,然后进入步骤S208。具体地,所述增量式PI调节包括:对最新调节过(步骤S203的P调节更新过)的机器人的驱动轮的PWM信号占空比、步骤S203更新后的当前行走速度与所述当前调节周期下配置的目标速度的速度差值与比例系数的乘积、步骤S203更新后的当前行走速度与所述当前调节周期下配置的目标速度的速度差值与积分系数的乘积相加求和,以获得增量式PI调节输出的占空比,并将急刹车标志位置逻辑0。与现有技术相比,本实施例在机器人的驱动轮的行走速度的变化过快(包括P调节过快)并接近当前调节周期下配置的目标速度时,把速度调节状态(前述P调节)地切换为增量式PI调节状态,进入一种平稳的PI调节状态下进行速度的调节,能够有效地减少机器人的驱动轮行走过程中产生的顿挫感,并对有效地减少静差,更能适应短时间的变化而不受过去的速度误差的影响。
因此,在本实施例中,所述驱动轮从0开始加速启动,由于机器人一开始不动,所以被配置初始占空比以促进机器人顺利启动,然后在所述增量式PI调节的过程中, 机器人的驱动轮的PWM信号占空比一直增加,若机器人的加油门信号很小并且外部处于大阻尼负载情况下,机器人的驱动轮也加大力矩输出,让驱动轮可以平稳起步,使得下一调节周期内经过前述的增量式PI调节输出的PWM信号占空比保持大于当前调节周期内经过调节输出的PWM信号占空比,而且是随着调节周期的先后到来,增量式PI调节输出的PWM信号占空比保持平稳地增加。
步骤S208、下发PWM信号占空比到更底层的程序去实现机器人的驱动轮的当前行走速度的控制,即控制机器人按照前述调节输出的PWM信号占空比执行加速运动,然后进入步骤S209。具体地,在步骤S204判断结果为否时,即经过所述P调节更新的行走速度与对应调节周期下配置的目标速度的速度差值的绝对值还没缩小为所述系统允许误差时,将步骤S203的P调节更新后的PWM信号占空比直接下发到机器人的更底层的程序,即把步骤S203的P调节更新后的PWM信号占空比直接输出至所述驱动轮对应的系统驱动层,实现机器人的行走速度的控制;若当前调节周期下配置的目标速度大于或等于所述驱动轮的码盘被允许读取的最低速度值,则选择将经过所述增量式PI调节更新的PWM信号占空比直接输出至所述驱动轮对应的系统驱动层;若经过所述P调节更新的行走速度与对应调节周期下配置的目标速度的速度差值的绝对值没有缩小为所述系统允许误差,则将经过同一P调节更新的PWM信号占空比直接输出至所述驱动轮对应的系统驱动层。从而实现控制机器人按照前述调节输出的PWM信号占空比执行加速运动,这正是本实施例的机器人从启动开始执行加速运动的触发控制机制,也是机器人按照前述PID调节方式输出的PWM信号占空比在不同调节周期内执行稳定的加速运动的触发控制机制,使得机器人的驱动轮从当前行走速度开始按照当前调节周期下的PWM信号占空比调节出的速度变化量做变速运动。
步骤S209、判断当前是否完成预先配置的最终目标速度匹配的最后一个调节周期内的速度调节步骤,是则进入步骤S210,否则进入步骤S211。
步骤S210、判断所述驱动轮的运动行走状态是否发生改变,是则结束当前运动行为下的行走速度调节方法,并开始切换到下一个不同类型的运动行为(比如减速运动)的最终目标速度的控制指令;否则返回步骤S205,此时视为已经将机器人的驱动轮的行走速度稳定地调节至最终目标速度,但需要重新返回步骤S205,通过执行增量式PI调节或所述低速开环调节来保证机器人的驱动轮的当前行走速度稳定地达到本实施例所预期的速度。
步骤S211、将当前调节周期下配置的目标速度更新为下一调节周期下配置的目标速度,然后返回步骤S203。需要说明的是,在本实施例中,可以将最新调节过的机器人的驱动轮的PWM信号占空比输出以供下一调节周期的P调节和增量式PI调节使用。
在步骤S211中,机器人的驱动轮在当前调节周期下的当前行走速度是先后经过P调节和增量式PI调节更新为新的行走速度,用于在下一调节周期内与下一调节周期下配置的目标速度进行比较以完成新的增量式PID调节;当然机器人的驱动轮在当前调节周期下的经过P调节过的行走速度也可以是没有被增量式PI调节更新过的,需要在下一调节周期内与下一调节周期下配置的目标速度进行比较,判断是否可以通过增量式PI调节来稳定地补偿经过P调节过的机器人的行走速度与下一调节周期下配置的目标速度的速度差,以实现调节后的行走速度稳定地接近于下一调节周期下配置的目标速度、或落入下一调节周期下配置的目标速度的临界误差范围内,并保证这一过程中产生的静差得以消除,产生的噪声干扰也得到合理的调节。需要说明的是,在每一个调节周期内,所述目标速度是按照预先配置的固定的预期加速度计算得到的,下一调节周期下配置的目标速度是比当前调节周期下配置的目标速度大。
因此,本实施例根据划分出的每个周期的目标速度,实现启动状态下的速度变化快慢的控制,特别是在刚刚启动运动的场景下(速度发生较大的变化)能快速地响应使实际行走速度更快接近目标速度,在当前行走速度接近目标速度时,柔和的控制机器人行走。
优选地,所述系统允许误差用于表示所述当前行走速度在经过所述P调节后,当前行走速度接近当前调节周期下配置的目标速度。所述系统允许误差优选为100tick/s。这一系统允许误差也充分考虑机器人在加速运动过程中所受到的阻力影响。
作为另一种实施例,刹车减速运动的实施场景中、或者是从前述实施例的加速运动的场景切换到刹车减速运动的实施场景时,提供一种基于方向的机器人行走速度调节方法,具体如图3所示,具体包括以下步骤:
步骤S301、在机器人按照当前的运动模式启动运动时,对驱动轮配置初始PWM信号占空比、最终目标速度、固定的预期加速度和调节周期,此时机器人按照这个固定的预期加速度和调节周期计算出每一个调节周期所预期达到的目标速度,以此作为对应调节周期下执行PID调节的速度判断依据;然后进入步骤S302。具体地,在机器人启动减速运动时,分别对机器人的左驱动轮和机器人的右驱动轮配置相匹配的初始PWM信号占空比,这些初始PWM信号占空比和实际速度相匹配,既可以减少在减速运动过程中P调节的时间,又确保了左驱动轮和右驱动轮的一致性。
步骤S302、根据驱动轮的码盘读数确定出机器人的运动状态,包括刹车减速运动,可以是慢减速使得机器人的运动方向不会发生改变。然后进入步骤S303。需要说明的是,左右驱动轮内的码盘单位采样时间内的实时脉冲计数可以得出实时左右驱动轮的速度值,左右驱动轮的脉冲计数,经过码盘计算与速度的转换公式(该转换公式可为本领域人员常用技术,也可为本申请人研究出的成果)得到机器人在当前运动行为下的整体速度,该整体速度为左右驱动轮的平均值),进而确定机器人的加速度大小。
步骤S303、机器人的驱动轮按照当前调节周期内调节出的速度变化量进行减速运动时,判断机器人的驱动轮的当前行走速度与当前调节周期内配置的目标速度的速度差值是否大于刹车速度差阈值,是则进入步骤S305,否则进入步骤S304。该步骤用于判断机器人的驱动轮在减速过程中是否出现减速异常的情况,包括出现减速过快的现象,比如刹车速度差阈值优选为400mm/s时,步骤S303则是判断机器人的驱动轮在步骤S302中减速运动中出现的当前行走速度是否比当前调节周期内配置的目标速度大400mm/s。需要说明的是,当出现减速过快的现象时,驱动轮的速度容易出现失控,对机器人的运动的稳定性产生影响。
步骤S304、判断当前调节周期内配置的目标速度是否为0,是则进入步骤S305,否则进入步骤S306。如果判断到机器人的驱动轮在减速过程中没有出现减速过快的情况,则利用该步骤去判断机器人的驱动轮在当前调节周期下配置的目标速度是否为0。因为在目标速度设置为0的情况下,本实施例需将驱动轮的当前行走速度调节至接近目标速度0,而当驱动轮的当前行走速度在0的附近时,驱动轮的当前行走速度的方向不确定,若调节输出的PWM信号占空比继续变得越来越大,则机器人的运动容易失控。
步骤S305、将所述驱动轮当前获得的PWM信号占空比反向处理以更新机器人的驱动轮的当前行走速度,使得机器人的驱动轮的当前行走速度与当前调节周期内配置的目标速度的速度差得到缩小,然后进入步骤S307;具体地,所述反向处理是作为一种开环调节方式,所述反向处理包括:将所述驱动轮当前获得的PWM信号占空比直接设置更新为用于减速的刹车信号占空比,,以获得反向处理输出的占空比信号,其中,这个反向处理输出的占空比信号用于供P调节在下一调节周期内累加使用和/或增量式PI调节在当前调节周期内累加使用,以降低机器人的驱动轮在当前行走方向上的速度大小;用于减速的刹车信号占空比的数值符号与所述驱动轮当前获得的PWM信号占空比的数值符号是相反的,使得用于减速的刹车信号占空比控制输出的速度变化量的方向与机器人的驱动轮的当前行走速度的方向是相反的。在一些实施场景中,对PWM信号占空比进行反向处理,比如当前行走速度是250mm/s,当前获得的PWM信号占空比是650,将当前获得的PWM信号直接设置为刹车信号占空比-20,直接作为反向处理输出的占空比信号,实现对机器人的驱动轮的当前行走速度的减速作用;若在下一调节周期中仍判断到机器人的驱动轮的当前行走速度与当前调节周期内配置的目标速度的速度差值大于刹车速度差阈值,则继续通过反向处理设置出新的刹车信号占空比-40,并将这个新的刹车信号占空比-40直接作为新的反向处理输出的占空比信号,直到所述驱动轮的行走速度被反向处理为接近对应调节周期内配置的目标速度,然后才能在后续步骤中进入所述增量式PI调节中对比较接近的驱动轮的当前行走速度和对应调节周期下配置的目标速度的速度差进行稳定的调节,增强驱动轮刹车减速的稳定性,以消除静差,并克服干扰。
步骤S306、当机器人的驱动轮按照当前调节周期内调节出的速度变化量进行刹车减速运动时,若步骤S304判断到当前调节周期内配置的目标速度为0,或者,步骤S303判断到机器人的驱动轮的当前行走速度与当前调节周期内配置的目标速度的速度差值大于刹车速度差阈值,则对机器人的驱动轮的当前行走速度与当前调节周期内配置的目标速度的速度差值进行P调节,让P调节输出的PWM信号占空比换算更新所述驱动轮的当前行走速度,以缩小驱动轮的行走速度与当前调节周期内配置的目标速度的速度差。然后进入步骤S307。需要说明的是,所述P调节的方法包括:将机器人的驱动轮在当前调节周期内更新前的当前行走速度与所述当前调节周期下配置的目标速度的速度差值与比例系数的乘积与所述驱动轮最新获得的PWM信号占空比相加,以获得P调节输出的PWM信号占空比,其中,P调节输出的PWM信号占空比用于控制更新机器人的驱动轮的当前行走速度,此时,机器人的驱动轮的当前行走速度与当前调节周期内配置的目标速度的速度差值不是特别大,但需要经过P调节以进一步地快速缩小两者的速度差值,减小超调和振荡,再在两者的速度差值足够小的时候切换到平稳的增量式PI调节中。本实施例仅使用P调节的方式去改变更新驱动轮的当前行走速度,从而加快PWM信号占空比调节的响应速度。在机器人执行刹车减速的过程中,通过P调节来让所述驱动轮的当前制动速度快速响应更新,增强机器人对刹车制动环境的敏感程度,防止超调和振荡。从而在机器人减速刹车这一速度快速变化的场景下能快速控制机器人达到预期的制动目标速度。因此,本实施例实现根据所述驱动轮所处的速度状态,确定对机器人的驱动轮的当前行走速度进行P调节,提高所述驱动轮按照PWM信号占空比行走的响应速度,减少机器人在实际刹车所需调节的时间。
步骤S307、判断步骤S305反向处理更新后的当前行走速度或步骤S306的P调节更新后的当前行走速度与当前调节周期下配置的目标速度的速度差值的绝对值是否缩小为所述系统允许误差,是则进入步骤S311,否则进入步骤S308。
优选地,所述系统允许误差用于表示所述当前行走速度在经过所述P调节或反向处理后,当前行走速度接近当前调节周期下配置的目标速度。所述系统允许误差优选为100tick/s。
因此通过设置所述系统允许误差来检测并触发调节减速过头的驱动轮的行走速度,避免步骤S305更新后的当前行走速度或步骤S306更新后的当前行走速度与当前调节周期下配置的目标速度的速度差值变得过大,进而及时防止后续增量式PI调节出的PWM信号占空比失控、以及下一调节周期内的P调节输出的PWM信号占空比失控。
步骤S308、判断当前调节周期下配置的目标速度是否小于所述驱动轮的码盘被读取的最低速度值,是则进入步骤S310,否则进入步骤S309。
步骤S310、将最新获得的机器人的驱动轮的PWM信号占空比更新为当前调节周期下配置的目标速度与一个低速开环系数的乘积,以实现低速开环调节经过步骤S306的P调节更新过的PWM信号占空比、或经过步骤S305的反向处理更新过的PWM信号占空比,间接控制更新驱动轮的当前行走速度,使用开环控制的方式解决码盘读数量程不够精准的问题,可以是按照低速开环系数增大所述目标速度,使得与当前调节周期下配置的目标速度的速度差值的绝对值是缩小为所述系统允许误差的当前行走速度能够在码盘上被正常读取,保证机器人在刚启动加速的场景下的速度数据能被码盘读取,并根据对应的读数正常行走。然后进入步骤S311。
步骤S309、使用增量式PI调节的方式,去调节更新步骤S306调节更新过的当前行走速度、或调节更新步骤S305更新处理过的当前行走速度,从而实现:根据机器人的驱动轮的当前行走速度与当前调节周期下配置的目标速度之间的一种大小比较关系,对机器人的驱动轮的当前行走速度进行增量式PI调节的方法,然后进入步骤S311。具体地,所述增量式PI调节包括:对最新调节过的机器人的驱动轮的PWM信号占空比(步骤S306的P调节结果或步骤S305的反向处理结果)、更新后的当前行走速度与所述当前调节周期下配置的目标速度的速度差值与比例系数的乘积、更新后的当前行走速度与所述当前调节周期下配置的目标速度的速度差值与积分系数的乘积相加求和,以获得增量式PI调节输出的占空比。与现有技术相比,本实施例在机器人的驱动轮的行走速度的变化过快(包括P调节过快)并接近当前调节周期下配置的目标速度时,把速度调节状态(前述反向处理或P调节)地切换为增量式PI调节状态,在短时间内进入一种平稳的刹车制动速度状态下,能够有效地减少机器人的驱动轮刹车行走过程中产生的顿挫感,并对有效地减少静差,更能适应短时间的变化而不受过去的速度误差的影响。
步骤S311、将更新调节过的PWM信号占空比输出至所述驱动轮对应的系统驱动层,实现机器人的行走速度的控制,然后进入步骤S312。在步骤S311中,步骤S309的增量式PI调节出的PWM信号占空比、步骤S310的低速开环调节出的PWM信号占空比输出至所述驱动轮对应的系统驱动层;或者,经过步骤S306所述P调节更新的行走速度与对应调节周期下配置的目标速度的速度差值的绝对值没有缩小为所述系统允许误差时,将步骤S306所述P调节更新的PWM信号占空比输出至所述驱动轮对应的系统驱动层;本实施例将前述的PWM信号占空比直接输出至所述驱动轮对应的系统驱动层,实现对机器人按照前述PWM信号占空比调节控制的行走速度在工作区域作刹车减速运动,然后进入步骤S312。从而实现控制机器人按照前述调节输出的PWM信号占空比执行加速运动,这正是本实施例的机器人从启动刹车开始执行稳定的减速运动的触发控制机制,也是机器人按照前述PID调节方式输出的PWM信号占空比在不同调节周期内执行稳定的加速运动的触发控制机制,使得机器人的驱动轮从当前行走速度开始按照当前调节周期下的PWM信号占空比调节出的速度变化量做慢减速运动,即前述步骤调节输出的PWM信号占空比不会改变机器人的驱动轮的速度方向。
步骤S312、判断当前是否完成预先配置的最终目标速度匹配的最后一个调节周期内的速度调节步骤,是则进入步骤S313,否则进入步骤S314。
步骤S313、判断所述驱动轮的运动行走状态是否发生改变,是则结束当前运动行为下的行走速度调节方法,并开始切换到下一个不同类型的运动行为(比如加速运动)的最终目标速度的控制指令;否则返回步骤S308,此时视为已经将机器人的驱动轮的行走速度稳定地调节至最终目标速度,但需要重新返回步骤S308,通过执行增量式PI调节或所述低速开环调节来保证机器人的驱动轮的当前行走速度稳定地达到本实施例所预期的速度。
步骤S314、将当前调节周期下配置的目标速度更新为下一调节周期下配置的目标速度,然后返回步骤S303。需要说明的是,在本实施例中,可以将最新调节过的机器人的驱动轮的PWM信号占空比输出以供下一调节周期的P调节和增量式PI调节累加使用。
在前述步骤中,机器人的驱动轮在当前调节周期下的当前行走速度可能经过P调节、增量式PI调节、低速开环调节、反向处理更新为新的行走速度,用于在下一调节周期内与下一调节周期下配置的目标速度进行比较以完成新的一轮对应的调节;当然机器人的驱动轮在当前调节周期下的经过P调节过的行走速度也可以是没有被增量式PI调节更新过的,需要在下一调节周期内与下一调节周期下配置的目标速度进行比较,判断是否可以通过增量式PI调节来稳定地补偿经过P调节过、反向处理过的机器人的行走速度与下一调节周期下配置的目标速度的速度差,以实现调节后的行走速度稳定地接近于下一调节周期下配置的目标速度、或落入下一调节周期下配置的目标速度的临界误差范围内,并保证这一过程中产生的静差得以消除,产生的噪声干扰也得到合理的调节,从而也确保在每一个调节周期内,所述目标速度是按照预先配置的固定的预期加速度计算得到的,下一调节周期下配置的目标速度是比当前调节周期下配置的目标速度小。
因此,本实施例根据划分出的每个周期的目标速度,实现启动状态下的速度变化快慢的控制,特别是在机器人刹车减速至零的场景下(速度发生较大的变化)能快速地响应使实际行走速度更快接近目标制动速度,在当前行走速度接近目标制动速度时,柔和的控制机器人刹车减速行走。实现在不同减速状态下都能实现精准控制。
优选地,所述系统允许误差用于表示所述当前行走速度在经过所述P调节或反向处理后,当前行走速度接近当前调节周期下配置的目标速度。所述系统允许误差优选为100tick/s。
在前述三个实施例的基础上,还包括对所述目标速度的限制处理,具体为:若判断到当前调节周期下配置的左驱动轮的目标速度和当前调节周期下配置的右驱动轮的目标速度都低于预先配置的最小驱动速度,则按预设放大比例系数同时放大左驱动轮的目标速度和右驱动轮的目标速度,再从放大后的左驱动轮的目标速度和放大后的右驱动轮的目标速度中选择最低的一个目标速度更新预先配置的最小驱动速度,用于作为下一调节周期的目标速度判断。若判断到当前调节周期下配置的左驱动轮的目标速度和当前调节周期下配置的右驱动轮的目标速度都大于预先配置的最大动速度,则按预设缩小比例系数同时缩小左驱动轮的目标速度和右驱动轮的目标速度,再从放大后的左驱动轮的目标速度和放大后的右驱动轮的目标速度中选择最大的一个目标速度更新预先配置的最大驱动速度,用于作为下一调节周期的目标速度判断。从而在每一个调节周期进行PID调节之前对目标速度进行限速处理,以满足预期的左右驱动轮的调速效果。
在每一个调节周期内,所述目标速度是按照预先配置的固定的预期加速度计算得到的;其中,调节周期的个数是由所述最终目标速度、预先配置的固定的预期加速度和调节周期的周期长度计算获得。实现:根据固定的预期加速度把最终目标速度划分成每个调节周期内对应的目标速度,实现速度变化快慢的控制,进而结合前述三个实施例在需要低速控制的场景下能柔和的控制机器行走,在需要速度快速变化的场合下能快速的响应使实际速度更快达到目标值。
显然,上述实施例仅仅是为清楚地说明所作的举例,而并非对实施方式的限定。对于所属领域的普通技术人员来说,在上述说明的基础上还可以做出其它不同形式的变化或变动。这里无需也无法对所有的实施方式予以穷举。而由此所引伸出的显而易见的变化或变动仍处于本发明创造的保护范围之中。
Claims (9)
1.一种机器人行走速度调节方法,其特征在于,包括:
步骤1、根据驱动轮所处的运动行走状态,确定对机器人的驱动轮的当前行走速度进行P调节的方式,以缩小当前行走速度与当前调节周期下配置的目标速度的速度差;然后进入步骤2;其中,所述驱动轮所处的运动行走状态是与机器人当前执行的运动行为相关联的;
步骤2、根据前述步骤1调节的当前行走速度与当前调节周期下配置的目标速度的大小关系,确定对前述步骤1调节的当前行走速度进行增量式PI调节的方式,以在步骤1调节基础上继续缩小当前行走速度与当前调节周期下配置的目标速度的速度差;然后进入步骤3;
步骤3、判断是否完成预先配置的最终目标速度匹配的最后一个调节周期内的速度调节步骤,是则进入步骤4,否则将当前调节周期下配置的目标速度更新为下一调节周期下配置的目标速度,再返回步骤1;其中,这个预先配置的最终目标速度是与机器人的驱动轮所处的不同的运动行走状态是相关联的;
步骤4、判断所述驱动轮所处的运动行走状态是否发生改变,是则返回步骤1,否则返回步骤2以维持执行所述增量式PI调节;
所述根据驱动轮所处的运动行走状态,确定对机器人的驱动轮的当前行走速度进行P调节的方式的方法包括:
当机器人的驱动轮在当前调节周期内切换到执行减速运动时,判断机器人的驱动轮的当前行走速度与当前调节周期内配置的目标速度的速度差值是否大于刹车速度差阈值,是则将所述驱动轮当前获得的PWM信号占空比反向处理以更新机器人的驱动轮的当前行走速度,使得机器人的驱动轮的当前行走速度与当前调节周期内配置的目标速度的速度差得到缩小;否则对机器人的驱动轮的当前行走速度进行P调节以更新所述驱动轮的当前行走速度,使得机器人的驱动轮的行走速度与当前调节周期内配置的目标速度的速度差得到缩小;
或者,当机器人的驱动轮在当前调节周期内切换到执行减速运动时,判断当前调节周期内配置的目标速度是否为0,是则将所述驱动轮当前获得的PWM信号占空比反向处理以更新机器人的驱动轮的当前行走速度,使得机器人的驱动轮的行走速度与当前调节周期内配置的目标速度的速度差得到缩小;否则对机器人的驱动轮的当前行走速度进行P调节以更新所述驱动轮的当前行走速度,使得机器人的驱动轮的行走速度与当前调节周期内配置的目标速度的速度差得到缩小;
其中,所述驱动轮所处的运动行走状态切换到减速运动。
2.根据权利要求1所述机器人行走速度调节方法,还包括:在机器人启动运行时,分别对左驱动轮和机器人的右驱动轮配置相匹配的初始PWM信号占空比;其中,所述驱动轮包括左驱动轮和右驱动轮;
然后根据所述驱动轮所处的运动行走状态,确定对机器人的驱动轮的当前行走速度进行P调节的方式。
3.根据权利要求2所述机器人行走速度调节方法,其特征在于,所述根据所述驱动轮所处的运动行走状态,确定对机器人的驱动轮的当前行走速度进行P调节的方式的方法包括:
当机器人的驱动轮在当前调节周期内切换到执行加速运动时,对机器人的驱动轮的当前行走速度与当前调节周期内配置的目标速度的速度差值进行P调节,使得P调节更新所述驱动轮的当前行走速度,以缩小所述驱动轮的当前行走速度与当前调节周期内配置的目标速度的速度差;
其中,所述驱动轮所处的运动行走状态切换到加速运动。
4.根据权利要求1所述机器人行走速度调节方法,其特征在于,所述反向处理包括:
将所述驱动轮当前获得的PWM信号占空比直接设置更新为用于减速的刹车信号占空比,以获得反向处理输出的占空比信号;其中,这个反向处理输出的占空比信号用于供P调节和/或增量式PI调节使用;用于减速的刹车信号占空比所指示的速度变化量方向与机器人的驱动轮的当前行走速度的方向是相反的。
5.根据权利要求3或4所述机器人行走速度调节方法,其特征在于,所述P调节的方法包括:
将机器人的驱动轮的当前行走速度与所述当前调节周期下配置的目标速度的速度差值与比例系数的乘积与所述驱动轮最新获得的PWM信号占空比相加,以获得P调节输出的PWM信号占空比,其中,P调节输出的PWM信号占空比用于更新机器人的驱动轮的当前行走速度。
6.根据权利要求5所述机器人行走速度调节方法,其特征在于,所述根据前述步骤1调节的当前行走速度与当前调节周期下配置的目标速度的大小关系,确定对前述步骤1调节的当前行走速度进行增量式PI调节的方式的方法包括:
判断经过所述P调节更新后的当前行走速度与当前调节周期下配置的目标速度的速度差值的绝对值是否缩小为系统允许误差,是则对最新调节过的机器人的驱动轮的PWM信号占空比、更新后的当前行走速度与所述当前调节周期下配置的目标速度的速度差值与比例系数的乘积、更新后的当前行走速度与所述当前调节周期下配置的目标速度的速度差值与积分系数的乘积相加求和,以获得增量式PI调节输出的占空比;否则将最新调节过的机器人的驱动轮的PWM信号占空比输出以供下一调节周期的P调节、增量式PI调节或低速开环调节使用;
其中,所述系统允许误差是100tick/s,这个tick/s是用于码盘表示的速度单位。
7.根据权利要求6所述机器人行走速度调节方法,其特征在于,在对机器人的驱动轮的当前行走速度进行增量式PI调节之前,还包括:
当更新后的当前行走速度与当前调节周期下配置的目标速度的速度差值的绝对值是缩小为所述系统允许误差时,判断当前调节周期下配置的目标速度是否小于所述驱动轮的码盘被允许读取的最低速度值,是则将最新调节过的机器人的驱动轮的PWM信号占空比更新为当前调节周期下配置的目标速度与一个低速开环系数的乘积,以实现低速开环调节更新最新更新获得的当前行走速度;否则使用前述的增量式PI调节,去继续调节更新最新更新获得的当前行走速度。
8.根据权利要求7所述机器人行走速度调节方法,其特征在于,若当前调节周期下配置的目标速度小于所述驱动轮的码盘被允许读取的最低速度值,则选择将经过所述低速开环调节更新的PWM信号占空比直接输出至所述驱动轮对应的系统驱动层;
若当前调节周期下配置的目标速度大于或等于所述驱动轮的码盘被允许读取的最低速度值,则选择将经过所述增量式PI调节更新的PWM信号占空比直接输出至所述驱动轮对应的系统驱动层;
若经过所述P调节更新的行走速度与对应调节周期下配置的目标速度的速度差值的绝对值不是缩小为所述系统允许误差,则将经过同一P调节更新的PWM信号占空比直接输出至所述驱动轮对应的系统驱动层。
9.根据权利要求8所述机器人行走速度调节方法,其特征在于,在每一个调节周期内,所述目标速度是按照预先配置的固定的预期加速度计算得到的;其中,调节周期的个数是由所述最终目标速度、预先配置的固定的预期加速度和调节周期的周期长度计算获得。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011491533.6A CN112603205B (zh) | 2020-12-17 | 2020-12-17 | 一种机器人行走速度调节方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011491533.6A CN112603205B (zh) | 2020-12-17 | 2020-12-17 | 一种机器人行走速度调节方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN112603205A CN112603205A (zh) | 2021-04-06 |
CN112603205B true CN112603205B (zh) | 2022-01-04 |
Family
ID=75239912
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202011491533.6A Active CN112603205B (zh) | 2020-12-17 | 2020-12-17 | 一种机器人行走速度调节方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN112603205B (zh) |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113296508B (zh) * | 2021-05-21 | 2022-10-04 | 福建盛海智能科技有限公司 | 一种自主变速循迹方法及无人车 |
CN113442139B (zh) * | 2021-06-29 | 2023-04-18 | 山东新一代信息产业技术研究院有限公司 | 基于ros操作系统的机器人速度控制方法及装置 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5270628A (en) * | 1990-12-30 | 1993-12-14 | Horiba, Ltd. | Method and apparatus for automatic robotic control of a vehicle |
JPH11294573A (ja) * | 1998-04-08 | 1999-10-29 | Toyota Motor Corp | 無段変速機を備えた車両の制御装置 |
GB2357147A (en) * | 1999-12-07 | 2001-06-13 | Rover Group | Estimating wheel speed as a function of applied torque and estimated resistive torque |
JP2002029281A (ja) * | 2000-07-13 | 2002-01-29 | Nissan Motor Co Ltd | 車両用追従走行制御装置 |
JP2003262240A (ja) * | 2002-03-07 | 2003-09-19 | Hitachi Ltd | 自動変速機のクリープ制御装置及び方法 |
CN104483968A (zh) * | 2014-12-02 | 2015-04-01 | 冯炳和 | 一种基于pid的四轮全向足球机器人运动控制方法 |
Family Cites Families (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US8046144B2 (en) * | 2007-06-26 | 2011-10-25 | Chrysler Group Llc | Systems and methods for non-linear proportional and derivative control during vehicle garage shifts |
CN106740273B (zh) * | 2016-12-12 | 2019-04-02 | 中国北方车辆研究所 | 用于电传动履带车辆控制的驾驶员信号解析方法 |
CN108501768B (zh) * | 2018-03-29 | 2021-05-07 | 南京航空航天大学 | 一种基于z轴陀螺仪及轮速差的两轮速度控制方法 |
-
2020
- 2020-12-17 CN CN202011491533.6A patent/CN112603205B/zh active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5270628A (en) * | 1990-12-30 | 1993-12-14 | Horiba, Ltd. | Method and apparatus for automatic robotic control of a vehicle |
JPH11294573A (ja) * | 1998-04-08 | 1999-10-29 | Toyota Motor Corp | 無段変速機を備えた車両の制御装置 |
GB2357147A (en) * | 1999-12-07 | 2001-06-13 | Rover Group | Estimating wheel speed as a function of applied torque and estimated resistive torque |
JP2002029281A (ja) * | 2000-07-13 | 2002-01-29 | Nissan Motor Co Ltd | 車両用追従走行制御装置 |
JP2003262240A (ja) * | 2002-03-07 | 2003-09-19 | Hitachi Ltd | 自動変速機のクリープ制御装置及び方法 |
CN104483968A (zh) * | 2014-12-02 | 2015-04-01 | 冯炳和 | 一种基于pid的四轮全向足球机器人运动控制方法 |
Non-Patent Citations (3)
Title |
---|
基于油门与制动的轮式移动机器人纵向速度控制;张相洪等;《北京理工大学学报》;20030228;第23卷(第1期);全文 * |
用于轮式移动机器人的一体化驱动系统设计和研发;曹晨;《中国优秀博硕士学位论文全文数据库(硕士)信息科技辑》;20080115(第01期);第35-36页 * |
轮式移动机器人的智能驱动控制系统研究;刘海烨;《中国优秀博硕士学位论文全文数据库(硕士)信息科技辑》;20131215(第S2期);全文 * |
Also Published As
Publication number | Publication date |
---|---|
CN112603205A (zh) | 2021-04-06 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN112603205B (zh) | 一种机器人行走速度调节方法 | |
CN112641384B (zh) | 机器人减速刹车状态下的pid调节方法 | |
US7915851B2 (en) | Numerical controller controlling acceleration and deceleration of respective control axes up to command speeds | |
US7479751B2 (en) | Elimination of unintended velocity reversals in s-curve velocity profiles | |
CN110626342A (zh) | 车间距离控制装置 | |
CN111231955A (zh) | 纵向车速的控制方法、装置、系统及存储介质 | |
US20200247385A1 (en) | Braking/driving force control system | |
CN112596529B (zh) | 基于方向的机器人行走速度调节方法、芯片及视觉机器人 | |
CN113311783A (zh) | 一种s型运动曲线规划方法及系统 | |
CN112511065B (zh) | 机器人启动加速运动中的pid调节方法 | |
US20210031771A1 (en) | Braking force control device | |
CN114802370A (zh) | 用于训练轨道车辆的控制装置的方法、控制装置和轨道车辆 | |
KR100842978B1 (ko) | 서보 제어방법 | |
US20220258745A1 (en) | Method and device for predictive vehicle control | |
JP2018039435A (ja) | 車間距離制御方法と車間距離制御装置 | |
CN112684703B (zh) | 一种速度受限的大行程点位运动控制方法 | |
CN111624952A (zh) | 一种基于Ethercat扭矩前馈的过象限补偿方法 | |
JP7433556B1 (ja) | リニアトラック制御装置およびリニアトラックシステム | |
CN110611470B (zh) | 一种速度伺服系统的控制方法 | |
CN113386793B (zh) | 线性和非线性控制结合低速稳态控制系统 | |
TWI399029B (zh) | 馬達速度控制方法、馬達速度控制器及具有馬達速度控制器之製造系統 | |
CN116545304A (zh) | 一种伺服电机的控制装置、方法和系统 | |
CN115402363A (zh) | 轨道机车恒速平稳性控制方法及相应轨道机车 | |
CN116954054A (zh) | 喷嘴挡板式定位器的控制方法、控制计算单元和定位器 | |
JPH05294171A (ja) | 車両用定速走行装置 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
CB02 | Change of applicant information |
Address after: 519000 2706, No. 3000, Huandao East Road, Hengqin new area, Zhuhai, Guangdong Applicant after: Zhuhai Yiwei Semiconductor Co., Ltd Address before: 519000 room 105-514, No. 6, Baohua Road, Hengqin new area, Zhuhai City, Guangdong Province (centralized office area) Applicant before: Zhuhai Yiwei Semiconductor Co., Ltd |
|
CB02 | Change of applicant information | ||
GR01 | Patent grant | ||
GR01 | Patent grant |