一种agv小车及其控制方法
【专利摘要】本发明属于于教学实验平台技术领域，具体提供一种AGV小车及其控制方法。AGV小车控制方法，包括：输入AGV小车的预先目的地，并启动AGV小车；检测AGV小车行进过程中的周围障碍；根据检测得到的周围障碍信息与预先目的地，获取AGV小车当前的水平移动距离Vx，垂直移动距离Vy以及旋转角度ω；根据水平移动距离Vx，垂直移动距离Vy以及旋转角度ω，进行四轮差速组合控制；根据四轮差速组合控制，在不需要转动AGV小车车体的基础上驱动AGV小车行进或者零半径转动，直到到达预先目的地。本发明能够在较小的空间实现AGV小车在任意方向的运动，减小空间对运动的影响。
【专利说明】
一种AGV小车及其控制方法
技术领域
[0001] 本发明属于教学实验平台技术领域，具体涉及一种AGV小车及其控制方法。
【背景技术】
[0002] AGV(Automated Guided Vehicle，自动导航平台），作为无人驾驶的搬运车，在工 业及实验中应用很广泛。然而，现有的AGV小车，由于无法实现零半径转弯等功能，在较小的 空间，运动受限制。
【发明内容】
[0003] 本发明的目的是提供一种AGV小车及其控制方法，能够在较小的空间实现AGV小车 的在任意方向的运动，减小空间对运动的影响。
[0004] 为此，本发明提供如下技术方案：
[0005] -种AGV小车控制方法，包括：
[0006] 步骤S1:输入AGV小车的预先目的地，并启动AGV小车；
[0007] 步骤S2:检测AGV小车行进过程中的周围障碍；
[0008] 步骤S3:根据检测得到的周围障碍信息与预先目的地，获取AGV小车当前的水平移 动距离Vx，垂直移动距离V y以及旋转角度《 ;
[0009] 步骤S4:根据水平移动距离Vx，垂直移动距离Vy以及旋转角度《，进行四轮差速组 合控制；
[0010] 步骤S5:根据四轮差速组合控制，在不需要转动AGV小车车体的基础上驱动AGV小 车行进或者零半径转动，直到到达预先目的地。
[0011]优选地，所述四轮差速组合控制的方法包括：
[0012] 步骤S41:根据AGV小车当前的水平移动距离Vx，垂直移动距离Vy以及旋转角度《得 到AGV小车的四个轮子的旋转角度；
[0013] 步骤S42:根据每个所述轮子的旋转角度得到每一所述轮子的驱动频率；
[0014]步骤S43:根据每一个所述轮子的所述驱动频率驱动每个所述轮子运动。
[0015]优选地，所述根据AGV小车当前的水平移动距离Vx，垂直移动距离Vy以及旋转角度 co得到AGV小车的四个轮子的旋转角度的方法为：
[0017]其中，0:为左前轮的旋转角度，02为右前轮的旋转角度，03为左后轮的旋转角度，0 4 为右后轮的旋转角度，liSAGV小车的长度的二分之一，12为AGV小车的宽度的二分之一，R为 轮子的半径。
[0018]优选地，所述每一个轮子的驱动机构为步进电机，所述根据每个所述轮子的旋转 角度得到每一所述轮子的驱动频率的方法为：
[0020] 其中，M为步进电机的细分控制量，心为左前轮的驱动频率，f2为右前轮的驱动频 率，f3为左后轮的驱动频率，f4为右后轮的驱动频率，9i为左前轮的旋转角度，02为右前轮的 旋转角度，93左后轮的旋转角度，04右后轮的旋转角度。
[0021] 本申请还提供一种AGV小车，包括：
[0022] 检测设备:用于检测AGV小车行进过程中的周围障碍；
[0023]处理系统：用于根据周围障碍信息与预先目的地，获取AGV小车当前的水平移动距 离Vx，垂直移动距离Vy以及旋转角度CO，并进行四轮差速控制；
[0024] 控制系统：用于输入AGV小车的预先目的地和AGV小车的启动，以及根据四轮差速 控制驱动AGV小车运动。
[0025] 优选地，所述检测设备包括接近传感器。
[0026] 优选地，所述接近传感器设有十二个，且沿AGV小车的车体的周向分布。
[0027] 优选地，所述检测设备还包括激光雷达。
[0028] 优选地，所述检测设备还包括视觉传感器。
[0029]优选地，还包括无线模块。
[0030]本发明的技术效果：
[0031] 本发明通过采用四轮差速控制，AGV小车能够实现零半径转弯，和在车体不转动的 状态下，AGV小车能够沿任意方向运动，因此，即使在较小的空间，AGV小车都能够实现任意 方向的运动，减小空间对运动的限制，提高AGV运动的灵活性。
【附图说明】
[0032] 图1是本发明所提供的AGV平台一种实施例的控制方法流程图；
[0033]图2是本发明所提供的AGV平台一种实施例的控制系统图；
[0034]图3是本发明所提供的AGV平台一种实施例的具体结构图。
[0035] 附图标记：
[0036]在图 1-3 中：
[0037] 1、检测设备，2、处理系统，3、控制系统，4、轮子，5、接近传感器，6、蓝牙模块，7、视 觉传感器，8、激光雷达，9、WI-FI模块，10、锂电池。
【具体实施方式】
[0038]下面详细描述本发明的实施例，所述实施例的示例在附图中示出，其中自始至终 相同或类似的标号表示相同或类似的元件或具有相同或类似功能的元件。下面通过参考附 图描述的实施例是示例性的，旨在用于解释本发明，而不能理解为对本发明的限制。
[0039 ]本发明提供的一种AGV小车控制方法，如图1所示，包括：
[0040]步骤S1:输入AGV小车的预先目的地，并启动AGV小车；
[0041] 步骤S2:检测AGV小车行进过程中的周围障碍；
[0042]步骤S3:根据检测得到的周围障碍信息与预先目的地，获取AGV小车当前的水平移 动距离Vx，垂直移动距离Vy以及旋转角度《，其中水平移动距离指AGV小车沿自身的宽度方 向的距离，垂直移动距离指AGV小车沿自身的长度方向的距离，由于AGV小车沿任意方向的 移动距离均可以分解为沿宽度方向的水平移动距离和沿长度方向的垂直移动距离；
[0043] 步骤S4:根据水平移动距离Vx，垂直移动距离Vy以及旋转角度《，进行四轮差速组 合控制；
[0044] 步骤S5:根据四轮差速组合控制，在不需要转动AGV小车车体的基础上驱动AGV小 车行进或者零半径转动，直到到达预先目的地。
[0045] 上述实施例通过采用四轮差速控制，AGV小车能够实现零半径转弯，和在车体不转 动的状态下，AGV小车能够沿任意方向运动，因此，即使在较小的空间，AGV小车都能够实现 任意方向的运动，减小空间对运动的限制，提高AGV运动的灵活性。
[0046] 其中，四轮差速组合控制的方法包括：
[0047]步骤S41:根据AGV小车当前的水平移动距离Vx，垂直移动距离Vy以及旋转角度《得 到AGV小车的四个轮子4的旋转角度；
[0048]步骤S42:根据每个轮子4的旋转角度得到每一轮子4的驱动频率；
[0049] 步骤S43:根据每一个轮子4的驱动频率驱动每个轮子运动。
[0050] 通过上述方法，能够简化控制系统。
[0051] 进一步地，根据AGV小车当前的水平移动距离Vx，垂直移动距离Vy以及旋转角度《 得到AGV小车的四个轮子的旋转角度的方法为：
[0053] 其中，01为左前轮的旋转角度，02为右前轮的旋转角度，03为左后轮的旋转角度，04 为右后轮的旋转角度，li为AGV小车的长度的二分之一，1 2为AGV小车的宽度的二分之一，R为 轮子的半径。
[0054] 采用这种方法，能够进一步简化控制程序。
[0055] 每一个轮子的驱动机构为步进电机，根据每个轮子的旋转角度得到每一个轮子4 的驱动频率的方法为：
[0057]其中，M为步进电机的细分控制量，心为左前轮的驱动频率，f2为右前轮的驱动频 率，f3为左后轮的驱动频率，f4为右后轮的驱动频率，9l为左前轮的旋转角度，02为右前轮的 旋转角度，93左后轮的旋转角度，04右后轮的旋转角度。
[0058]根据上述算法，能够简化控制程序和算法，便于控制操作。
[0059] 上述方法的驱动频率，也可以通过直接输入不同的频率，以进行调节。
[0060] 本申请还提供一种AGV小车，如图2所示，包括：
[0061] 检测设备1:用于检测AGV小车行进过程中的周围障碍；
[0062] 处理系统2:用于根据周围障碍信息与预先目的地，获取AGV小车当前的水平移动 距离Vx，垂直移动距离V y以及旋转角度《，并进行四轮差速控制；
[0063] 控制系统3:用于输入AGV小车的预先目的地和AGV小车的启动，以及根据四轮差速 控制驱动AGV小车运动。
[0064] 通过四轮差速控制的处理系统，在较小的空间，AGV小车都能够实现任意方向的运 动，减小空间对运动的限制，提高AGV运动的灵活性。
[0065] 具体地，如图3所示，检测设备1包括接近传感器5,该设置能够方便系统信号的传 递和周围环境的检测。
[0066] 接近传感器5可以设有一个，两个或者更多个，优选设有十二个，且沿AGV小车的车 体的周向分布，以更好地获得周边障碍的信息。
[0067] 检测设备1还包括激光雷达8,以更好地获得周边障碍的信息。
[0068] 检测设备1还包括视觉传感器7,以更好地获得周边障碍的信息。
[0069] 检测设备1也可以仅包括接近传感器5、激光雷达8和视觉传感器7中的一者或者两 者，也可以三者均包括，当然，也可以还包括其它传感器。
[0070] AGV小车还包括无线模块，如蓝牙模块6和WI-FI模块9,以方便与外界通讯。
[0071 ] AGV小车还包括锂电池10，以方便供电。当然其供电也可以通过有线电源，或者其 它动力电池。
[0072]在本发明的描述中，需要理解的是，术语"中心"、"纵向"、"横向"、"长度"、"宽度"、 "厚度"、"上"、"下"、"前"、"后"、"左"、"右"、"竖直"、"水平"、"顶"、"底" "内"、"外"、"顺时 针"、"逆时针"、"轴向"、"径向"、"周向"等指示的方位或位置关系为基于附图所示的方位或 位置关系，仅是为了便于描述本发明和简化描述，而不是指示或暗示所指的装置或元件必 须具有特定的方位、以特定的方位构造和操作，因此不能理解为对本发明的限制。
[0073]此外，术语"第一"、"第二"仅用于描述目的，而不能理解为指示或暗示相对重要性 或者隐含指明所指示的技术特征的数量。由此，限定有"第一"、"第二"的特征可以明示或者 隐含地包括一个或者更多个该特征。在本发明的描述中，"多个"的含义是两个以上，除非另 有明确具体的限定。
[0074] 在本发明中，除非另有明确的规定和限定，术语"安装"、"相连"、"连接"、"固定"等 术语应做广义理解，例如，可以是固定连接，也可以是可拆卸连接，或成一体;可以是机械连 接，也可以是电连接;可以是直接相连，也可以通过中间媒介间接相连，可以是两个元件内 部的连通或两个元件的相互作用关系。对于本领域的普通技术人员而言，可以根据具体情 况理解上述术语在本发明中的具体含义。
[0075] 在本发明中，除非另有明确的规定和限定，第一特征在第二特征"上"或"下"可以 是第一和第二特征直接接触，或第一和第二特征通过中间媒介间接接触。而且，第一特征在 第二特征"之上"、"上方"和"上面"可是第一特征在第二特征正上方或斜上方，或仅仅表示 第一特征水平高度高于第二特征。第一特征在第二特征"之下"、"下方"和"下面"可以是第 一特征在第二特征正下方或斜下方，或仅仅表示第一特征水平高度小于第二特征。
[0076] 在本说明书的描述中，参考术语"一个实施例"、"一些实施例"、"示例"、"具体示 例"、或"一些示例"等的描述意指结合该实施例或示例描述的具体特征、结构、材料或者特 点包含于本发明的至少一个实施例或示例中。在本说明书中，对上述术语的示意性表述不 必须针对的是相同的实施例或示例。而且，描述的具体特征、结构、材料或者特点可以在任 一个或多个实施例或示例中以合适的方式结合。此外，在不相互矛盾的情况下，本领域的技 术人员可以将本说明书中描述的不同实施例或示例以及不同实施例或示例的特征进行结 合和组合。
[0077] 尽管上面已经示出和描述了本发明的实施例，可以理解的是，上述实施例是示例 性的，不能理解为对本发明的限制，本领域的普通技术人员在本发明的范围内可以对上述 实施例进行变化、修改、替换和变型。
【主权项】
1. 一种AGV小车控制方法，其特征在于，包括： 步骤S1:输入AGV小车的预先目的地，并启动AGV小车； 步骤S2:检测所述AGV小车行进过程中的周围障碍； 步骤S3:根据检测得到的周围障碍信息与所述预先目的地，获取所述AGV小车当前的水 平移动距离Vx，垂直移动距离Vy以及旋转角度ω ; 步骤S4:根据所述水平移动距离Vx，所述垂直移动距离Vy以及所述旋转角度ω，进行四 轮差速组合控制； 步骤S5:根据四轮差速组合控制，在不需要转动所述AGV小车车体的基础上驱动所述 AGV小车行进或者零半径转动，直到到达预先目的地。2. 根据权利要求1所述的AGV小车控制方法，其特征在于，所述四轮差速组合控制的方 法包括： 步骤S41:根据所述AGV小车当前的水平移动距离Vx，垂直移动距离Vy以及旋转角度ω得 到AGV小车的四个轮子的旋转角度； 步骤S42:根据每个所述轮子的旋转角度得到每一所述轮子的驱动频率； 步骤S43:根据每一个所述轮子的所述驱动频率驱动每个所述轮子运动。3. 根据权利要求2所述的AGV小车控制方法，其特征在于，所述根据AGV小车当前的所述 水平移动距离Vx，所述垂直移动距离V y以及所述旋转角度ω得到所述AGV小车的四个轮子的 旋转角度的方法为：其中，9:为左前轮的旋转角度，02为右前轮的旋转角度，θ3为左后轮的旋转角度，θ4为右 后轮的旋转角度，li为AGV小车的长度的二分之一，12为AGV小车的宽度的二分之一，R为轮子 的半径。4. 根据权利要求3所述的AGV小车控制方法，其特征在于，所述每一个轮子的驱动机构 为步进电机，所述根据每个所述轮子的旋转角度得到每一所述轮子的驱动频率的方法为：其中，Μ为步进电机的细分控制量，心为左前轮的驱动频率，f2为右前轮的驱动频率，f3 为左后轮的驱动频率，f4为右后轮的驱动频率，9:为左前轮的旋转角度，θ2为右前轮的旋转 角度，θ 3左后轮的旋转角度，θ4右后轮的旋转角度。5. -种AGV小车，其特征在于，包括： 检测设备:用于检测AGV小车行进过程中的周围障碍； 处理系统：用于根据周围障碍信息与预先目的地，获取所述AGV小车当前的水平移动距 离Vx，垂直移动距离Vy以及旋转角度ω，并进行四轮差速控制； 控制系统：用于输入AGV小车的预先目的地和所述AGV小车的启动，以及根据四轮差速 控制驱动所述AGV小车运动。6. 根据权利要求5所述的AGV小车，其特征在于，所述检测设备包括接近传感器。7. 根据权利要求6所述的AGV小车，其特征在于，所述接近传感器设有十二个，且沿AGV 小车的车体的周向分布。8. 根据权利要求6所述的AGV小车，其特征在于，所述检测设备还包括激光雷达。9. 根据权利要求5-8任一项所述的AGV小车，其特征在于，所述检测设备还包括视觉传 感器。10. 根据权利要求5所述的AGV小车，其特征在于，还包括无线模块。
【文档编号】G05D1/02GK105929829SQ201610432040
【公开日】2016年9月7日
【申请日】2016年6月15日
【发明人】丁尧
【申请人】丁尧