CN107618614B - 一种二轮单轨车辆及其平衡的控制方法 - Google Patents
一种二轮单轨车辆及其平衡的控制方法 Download PDFInfo
- Publication number
- CN107618614B CN107618614B CN201710810933.0A CN201710810933A CN107618614B CN 107618614 B CN107618614 B CN 107618614B CN 201710810933 A CN201710810933 A CN 201710810933A CN 107618614 B CN107618614 B CN 107618614B
- Authority
- CN
- China
- Prior art keywords
- motor
- wheel
- vehicle
- driver
- drive signal
- 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
Classifications
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02T—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
- Y02T10/00—Road transport of goods or passengers
- Y02T10/60—Other road transportation technologies with climate change mitigation effect
- Y02T10/72—Electric energy management in electromobility
Abstract
本发明提供了一种二轮单轨车辆及其平衡的控制方法,车的前轮和后轮上均安装转向和驱动电机。车辆中嵌入式电脑根据车辆行驶状态和用户输入的行驶目标数据,计算并输出修正后的电机驱动信号到电机驱动子系统,电机驱动子系统驱动安装在车上的前后轮转向电机,前后轮驱动电机和前后轮刹车,使得二轮转向单轨车辆达到动态平衡、并按照行驶目标数据规划行驶。
Description
技术领域
本发明涉及二轮单轨车辆控制领域,更具体的说,涉及一种二轮单轨车辆及其平衡的控制方法。
背景技术
二轮单轨车辆,例如:电动自行车和摩托车,以高节能、低排放和低空间占用率,越来越受到用户的喜爱,进而二轮单轨车辆的使用率逐年上升。
驾驶人在使用二轮单轨车辆时,为了保证二轮单轨车辆的动态平衡,提出了自动控制平衡的二轮单轨车辆,自动控制平衡的二轮单轨车辆上的控制器根据车辆上安装的传感器测量得到的车辆行驶状态和行驶目标数据,采用多体动力学模型和欠驱动系统控制方法,控制二轮单轨车辆的转向电机和刹车驱动器,以达到二轮单轨车辆的动态平衡。
自动控制平衡的二轮单轨车辆中的转向电机只有在非零速度的情况下才能够调节车身重心和车轮支撑点的相对位置,所以现有的自动控制平衡的二轮单轨车辆,在车辆从停车状态到行驶状态或者是从行驶状态到停车状态时,不能自动保持动态平衡。
发明内容
有鉴于此,本发明提供一种二轮单轨车辆及其平衡的控制方法,以解决现有的自动控制平衡的二轮单轨车辆,在车辆从停车状态到行驶状态或者是从行驶状态到停车状态时,不能自动保持动态平衡的问题。
为解决上述技术问题,本发明采用了如下技术方案:
一种二轮单轨车辆,包括车身、安装在车身前部的可转向的前轮、安装在车后部的可转向后轮、传感器子系统、嵌入式电脑和电机驱动子系统;其中,所述电机驱动子系统包括前轮转向电机驱动器、前轮驱动电机驱动器、前轮刹车驱动器、后轮转向电机驱动器、后轮驱动电机驱动器和后轮刹车驱动器构成;
所述传感器子系统,用于采集二轮单轨车辆的车辆行驶状态和行驶目标数据;
所述嵌入式电脑,用于根据所述车辆行驶状态和所述行驶目标数据,计算得到协同的电机驱动信号,对计算得到的协同的电机驱动信号进行修正,得到修正后的电机驱动信号,输出修正后的电机驱动信号到电机驱动子系统;
所述电机驱动子系统,用于根据修正后的电机驱动信号中的每个信号控制相应的电机的力矩输出,使得二轮单轨车辆达到动态平衡、并按照行驶目标数据规划行驶。
优选地,所述嵌入式电脑用于根据所述车辆行驶状态和所述行驶目标数据,计算得到协同的电机驱动信号时,具体用于:
根据所述车辆行驶状态和所述行驶目标数据,基于非线性变系统动力学模型和非线性控制模型,计算得到协同的电机驱动信号。
优选地,所述嵌入式电脑用于根据所述车辆行驶状态和所述行驶目标数据,计算得到协同的电机驱动信号时,具体用于:
根据所述行驶目标数据,计算得到驾驶人的意愿路径;其中,所述行驶目标数据包括驾驶人输入的方向盘信息、刹车踏板信息和油门踏板信息;
根据所述传感器子系统采集的车辆行驶状态以及所述意愿路径,计算得到前轮转向电机驱动器、前轮驱动电机驱动器、前轮刹车驱动器、后轮转向电机驱动器、后轮驱动电机驱动器和后轮刹车驱动器的控制信号。
优选地,所述嵌入式电脑用于根据所述车辆行驶状态和所述行驶目标数据,计算得到协同的电机驱动信号时,具体用于:
根据所述行驶目标数据以及所述传感器子系统采集的车辆行驶状态,计算得到前轮转向电机驱动器、前轮驱动电机驱动器、前轮刹车驱动器、后轮转向电机驱动器、后轮驱动电机驱动器和后轮刹车驱动器的控制信号。
优选地,所述嵌入式电脑用于对计算得到的协同的电机驱动信号进行修正,得到修正后的电机驱动信号时,具体用于:
通过所述传感器子系统实时采集的二轮单轨车辆的车辆行驶状态和所述行驶目标数据的比对结果,对计算得到的协同的电机驱动信号进行修正,得到修正后的电机驱动信号。
优选地,所述电机驱动子系统用于根据修正后的电机驱动信号中的每个信号控制相应的电机的力矩输出时,具体用于:
所述前轮转向电机驱动器根据所述修正后的电机驱动信号中的前轮转向驱动信号,控制前轮转向电机的力矩输出;
所述前轮驱动电机驱动器根据所述修正后的电机驱动信号中的前轮驱动信号,控制前轮驱动电机的力矩输出;
所述前轮刹车驱动器根据所述修正后的电机驱动信号中的前轮刹车驱动信号,控制前轮刹车电机的力矩输出;
所述后轮转向电机驱动器根据所述修正后的电机驱动信号中的后轮转向驱动信号,控制后轮转向电机的力矩输出;
所述后轮驱动电机驱动器根据所述修正后的电机驱动信号中的后轮驱动信号,控制后轮驱动电机的力矩输出;
所述后轮刹车驱动器根据所述修正后的电机驱动信号中的后轮刹车驱动信号,控制后轮刹车电机的力矩输出。
一种二轮单轨车辆平衡的控制方法,应用于二轮单轨车辆,包括:
传感器子系统采集二轮单轨车辆的车辆行驶状态和行驶目标数据;
嵌入式电脑根据所述车辆行驶状态和所述行驶目标数据,计算得到协同的电机驱动信号,对计算得到的协同的电机驱动信号进行修正,得到修正后的电机驱动信号,输出修正后的电机驱动信号到电机驱动子系统;
电机驱动子系统根据修正后的电机驱动信号中的每个信号控制相应的电机的力矩输出,使得二轮单轨车辆达到动态平衡、并按照行驶目标数据规划行驶。
优选地,所述嵌入式电脑根据所述车辆行驶状态和所述行驶目标数据,计算得到协同的电机驱动信号,包括:
根据所述车辆行驶状态和所述行驶目标数据,基于非线性变系统动力学模型和非线性控制模型,计算得到协同的电机驱动信号。
优选地,所述嵌入式电脑根据所述车辆行驶状态和所述行驶目标数据,计算得到协同的电机驱动信号,包括:
根据所述行驶目标数据,计算得到驾驶人的意愿路径;其中,所述行驶目标数据包括驾驶人输入的方向盘信息、刹车踏板信息和油门踏板信息;
根据所述传感器子系统采集的车辆行驶状态以及所述意愿路径,计算得到前轮转向电机驱动器、前轮驱动电机驱动器、前轮刹车驱动器、后轮转向电机驱动器、后轮驱动电机驱动器和后轮刹车驱动器的控制信号。
优选地,所述嵌入式电脑根据所述车辆行驶状态和所述行驶目标数据,计算得到协同的电机驱动信号,包括:
根据所述行驶目标数据以及所述传感器子系统采集的车辆行驶状态,计算得到前轮转向电机驱动器、前轮驱动电机驱动器、前轮刹车驱动器、后轮转向电机驱动器、后轮驱动电机驱动器和后轮刹车驱动器的控制信号。
优选地,所述嵌入式电脑对计算得到的协同的电机驱动信号进行修正,得到修正后的电机驱动信号,包括:
通过所述传感器子系统实时采集的二轮单轨车辆的车辆行驶状态和所述行驶目标数据的比对结果,对计算得到的协同的电机驱动信号进行修正,得到修正后的电机驱动信号。
优选地,所述电机驱动子系统根据修正后的电机驱动信号中的每个信号控制相应的电机的力矩输出,包括:
所述前轮转向电机驱动器根据所述修正后的电机驱动信号中的前轮转向驱动信号,控制前轮转向电机的力矩输出;
所述前轮驱动电机驱动器根据所述修正后的电机驱动信号中的前轮驱动信号,控制前轮驱动电机的力矩输出;
所述前轮刹车驱动器根据所述修正后的电机驱动信号中的前轮刹车驱动信号,控制前轮刹车电机的力矩输出;
所述后轮转向电机驱动器根据所述修正后的电机驱动信号中的后轮转向驱动信号,控制后轮转向电机的力矩输出;
所述后轮驱动电机驱动器根据所述修正后的电机驱动信号中的后轮驱动信号,控制后轮驱动电机的力矩输出;
所述后轮刹车驱动器根据所述修正后的电机驱动信号中的后轮刹车驱动信号,控制后轮刹车电机的力矩输出。
相较于现有技术,本发明具有以下有益效果:
本发明提供了一种二轮单轨车辆及其平衡的控制方法,本发明中嵌入式电脑根据所述车辆行驶状态和所述行驶目标数据,计算得到协同的电机驱动信号,对计算得到的协同的电机驱动信号进行修正,得到修正后的电机驱动信号,输出修正后的电机驱动信号到电机驱动子系统后,所述电机驱动子系统,用于根据协同的电机驱动信号中的每个信号控制相应的电机的力矩输出,使得二轮单轨车辆达到动态平衡、并按照行驶目标数据规划行驶。这种方法不对车辆的状态进行限定,即车辆无论是处于停止状态,行驶状态,或者是停车状态和行驶状态之间的相互切换状态时,均能够保证车辆动态平衡行驶,解决了现有的自动控制平衡的二轮单轨车辆,在车辆从停车状态到行驶状态或者是从行驶状态到停车状态时,不能自动保持动态平衡的问题。
附图说明
为了更清楚地说明本发明实施例或现有技术中的技术方案,下面将对实施例或现有技术描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本发明的实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据提供的附图获得其他的附图。
图1为本发明提供的一种二轮单轨车辆的结构示意图;
图2为本发明提供的一种二轮单轨车辆的部分结构示意图;
图3为本发明提供的一种嵌入式电脑执行的方法的方法流程图;
图4为本发明提供的一种二轮单轨车辆平衡的控制方法的方法流程图。
具体实施方式
下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
本发明实施例提供了一种二轮单轨车辆,其中,二轮单轨车辆包括但不限于自行车、摩托车等两个车轮的车辆。本发明中的二轮单轨车辆特指二轮转向、二轮驱动单轨车辆。
为了本领域的技术人员能够更加清楚的了解二轮转向、二轮驱动单轨车辆的结构,现结合图1对一种二轮单轨车辆的结构进行介绍。
图1中,二轮单轨车辆包括:
带前轮驱动电机和刹车驱动器的前轮1、前轮转向电机2、电子显示单元3、电子方向盘4、单轨车辆车身5、无线通信天线6、嵌入式电脑7、惯性传感器8、导航模块9、通信模块10、后轮编码器11、带后轮驱动电机和刹车驱动器的后轮12、后轮转向电机13、电子加速踏板14、电子刹车踏板15和前轮编码器16。
其中,前轮1、电子方向盘4、单轨车辆车身5和后轮12组成了车身的整体架构。电子方向盘4用于人工控制车辆行驶方向,前轮驱动电机和后轮驱动电机用于驱动车辆行驶,前轮刹车驱动器和后轮刹车驱动器用于在刹车时,使车辆尽快停止,前轮转向电机2和后轮转向电机13用于在车辆转向时,驱动车辆转向。
电子显示单元3包括LCD显示屏、LED图像和LED点阵显示,主要用于显示车身滚动角、转向角等状态和行驶目标数据。无线通信天线6用于发射或接收电磁波。
惯性传感器8用于测量车身角速度向量和车身加速度向量,前轮编码器13用于测量前轮转向角、前轮转动角、前轮转向角速度和前轮转动角速度。后轮编码器11用于测量后轮转向角、后轮转动角、后轮转向角速度和后轮转动角速度。
导航模块9用于实现车辆路径的导航,其中,导航模块9可以是GPS模块。通信模块10是用来与外接设备进行通信的模块,外接设备可以是服务器等设备。
嵌入式电脑7是实现车辆平衡的关键部件,嵌入式电脑7输出控制信号给转向电机和驱动电机,在行驶过程中,嵌入式电脑7连续调节转向电机的转动方向和速度以达到车辆的动态平衡;在停止状态下,嵌入式电脑7指令前轮转向电机和后轮转向电机使得车辆固定于大转向角,然后持续控制前轮驱动电机和后轮驱动电机的力矩的方向和大小,达到准静态平衡。
本实施例中前轮转向电机2安装在了前叉上,后轮转向电机13安装在后轮上。二轮转向、二轮驱动单轨车辆包括电动自行车和电动摩托车等。电动自行车和电动摩托车通常是由车身,可以转向的前叉,前轮和可以转向的后轮组成。车辆是由安装在前轮和后轮上的无刷电机驱动。通常的单轨车辆转向是由驾驶人转动车把,带动前叉和前轮,改变前轮的前进方向。本发明的电脑控制的自动平衡二轮转向、二轮驱动单轨车辆利用传感器,包括惯性传感器和光编码器等,测量二轮转向、二轮驱动单轨车辆的状态,结合驾驶人或者事先确定的道路轨迹,再利用非线性变系统动力学模型和非线性控制模型,控制前轮转向电机和前轮驱动电机,带动前叉和前轮,控制后轮转向电机和驱动电机,以及前轮和后轮的刹车驱动器达到车辆的动态平衡,并按照行驶目标数据规划行驶。
本发明实施例提供了一种二轮单轨车辆,二轮单轨车辆除包括车身、安装在车身前部的可转向的前轮、安装在车后部的可转向后轮之外,参照图2,还包括传感器子系统11、嵌入式电脑12和电机驱动子系统13;其中,电机驱动子系统13包括前轮转向电机驱动器、前轮驱动电机驱动器、前轮刹车驱动器、后轮转向电机驱动器、后轮驱动电机驱动器和后轮刹车驱动器构成。传感器子系统11、嵌入式电脑12和电机驱动子系统13组成二轮单轨车辆平衡的控制系统。
传感器子系统11包括导航模块、前轮转动编码器、前轮转向编码器、后轮转动编码器、后轮转向编码器、惯性传感器和通信模块。
嵌入式电脑12为安装有控制软件的电脑,控制软件是基于非线性变系统动力学和非线性控制方法的软件。
具体的,传感器子系统11,用于采集二轮单轨车辆的车辆行驶状态和行驶目标数据;
嵌入式电脑,用于根据车辆行驶状态和行驶目标数据,计算得到协同的电机驱动信号,对计算得到的协同的电机驱动信号进行修正,得到修正后的电机驱动信号,输出修正后的电机驱动信号到电机驱动子系统;
电机驱动子系统,用于根据修正后的电机驱动信号中的每个信号控制相应的电机的力矩输出,使得二轮单轨车辆达到动态平衡、并按照行驶目标数据规划行驶。
具体的,车辆行驶状态包括:
车辆位置信息、车辆速度、前轮转向角、前轮转动角、前轮转向角速度、前轮转动角速度、后轮转向角、后轮转动角、后轮转向角速度、后轮转动角速度和车身姿态角信息。
其中,车辆速度是由车辆上安装的导航模块测量得到。导航模块可以是GPS模块,也可以是其他的模块。
前轮转向角、前轮转动角、前轮转向角速度和前轮转动角速度是由前轮转向编码器和前轮转动编码器测量得到,前轮转向编码器和前轮转动编码器可以是前轮光编码器。需要说明的是,后轮也安装有后轮转向编码器和后轮转动编码器,设置后轮转向编码器和后轮转动编码器的作用是测量得到后轮转向角、后轮转动角、后轮转向角速度和后轮转动角速度,后轮转向编码器和后轮转动编码器测量的数据是为了验证前轮转向编码器和前轮转动编码器测量得到的数据是否正确,以免前轮转向编码器和前轮转动编码器出现故障时,测量数据出错。
前轮转向角是由前轮转向光编码器测量得到,前轮转向光编码器还能够测量得到车轮转向角速度。
后轮车轮转向角是由后轮转向光编码器测量得到,后轮转向光编码器还能够测量得到后车轮转向角速度。
姿态角信息是指车辆的偏航角、车身滚动角和俯仰角。具体的,惯性传感器测量车身角速度向量和车身加速度向量,车身角速度向量包括偏航角速度分量、滚动角速度分量和俯仰角速度分量,车身加速度分量包括偏航角加速度分量、滚动角加速度分量和俯仰角加速度分量,然后根据车身角速度向量和车身加速度向量计算得到车辆的偏航角、滚动角和俯仰角。
车辆位置信息是由导航模块测量得到的位置信息以及根据车身角速度向量和车身加速度向量计算得到的位置信息,进行综合得到的信息。
可选的,在本实施例的基础上,嵌入式电脑用于根据车辆行驶状态和行驶目标数据,计算得到协同的电机驱动信号时,具体用于:
根据车辆行驶状态和行驶目标数据,基于非线性变系统动力学模型和非线性控制模型,计算得到协同的电机驱动信号。
其中,协同的电机驱动信号中包括前轮驱动信号、前轮刹车驱动信号、前轮转向驱动信号、后轮驱动信号、后轮刹车驱动信号和后轮转向驱动信号。
可选的,在本实施例的基础上,电机驱动子系统用于根据修正后的电机驱动信号中的每个信号控制相应的电机的力矩输出时,具体用于:
前轮转向电机驱动器根据修正后的电机驱动信号中的前轮转向驱动信号,控制前轮转向电机的力矩输出;
前轮驱动电机驱动器根据修正后的电机驱动信号中的前轮驱动信号,控制前轮驱动电机的力矩输出;
前轮刹车驱动器根据修正后的电机驱动信号中的前轮刹车驱动信号,控制前轮刹车电机的力矩输出。
后轮转向电机驱动器根据修正后的电机驱动信号中的后轮转向驱动信号,控制后轮转向电机的力矩输出;
后轮驱动电机驱动器根据修正后的电机驱动信号中的后轮驱动信号,控制后轮驱动电机的力矩输出;
后轮刹车驱动器,用于根据修正后的电机驱动信号中的后轮刹车驱动信号,控制后轮刹车电机的力矩输出。
本实施例中,嵌入式电脑根据车辆行驶状态和行驶目标数据,计算得到协同的电机驱动信号,对计算得到的协同的电机驱动信号进行修正,得到修正后的电机驱动信号,输出修正后的电机驱动信号到电机驱动子系统后,电机驱动子系统,用于根据协同的电机驱动信号中的每个信号控制相应的电机的力矩输出,使得二轮单轨车辆达到动态平衡、并按照行驶目标数据规划行驶。这种方法不对车辆的状态进行限定,即车辆无论是处于停止状态,行驶状态,或者是停车状态和行驶状态之间的相互切换状态时,均能够保证车辆动态平衡行驶,解决了现有的自动控制平衡的二轮单轨车辆,在车辆从停车状态到行驶状态或者是从行驶状态到停车状态时,不能自动保持动态平衡的问题。
为了本领域的技术人员能够进一步理解非线性变系统动力学模型和非线性控制模型,现对非线性变系统动力学模型和非线性控制模型进行解释说明。
二轮转向、二轮驱动单轨车辆平衡控制系统比通常前轮转向单轨车辆复杂很多。首先车辆从3个自由度变成了4个自由度,动力学方程增加了一维。更复杂的是系统的自由度和车辆状态有关。当前后轮转弯角处于某个角度下,前后轮的转动角不再受到约束,系统从4个自由度变成5个自由度。动态的系统自由度让原来的控制方法不再实用。
具体的,二轮转向、二轮驱动单轨车辆和忽略了前叉弹簧,后轮减震的情况下满足四个自由度的非线性欠驱动机械手方程:
其中,q为车辆状态矢量,M是4x4质量矩阵,C是4x4科里奥利/离心力项,G是重力项,K是力矩耦合矩阵,τ是前轮驱动和刹车力矩、前轮转向电机力矩、后轮转向电机力矩、后轮驱动和刹车力矩。。它们的表达式为:
q1,q2,q3,q4代表车身滚动角,前轮转向角、后轮转向角和前轮转动角。矩阵M,C,G,K的矩阵元是车身滚动角、前轮转向角和后轮转向角的已知解析函数。它们还和车辆的几何和动力学参数有关,τ1、τ2、τ3、τ4分别为前轮驱动和刹车力矩、前轮转向电机力矩、后轮转向电机力矩、后轮驱动和刹车力矩。
由于K的矩阵的第一行为0,力矩τ对车身滚动角方程没有任何影响,所以车身滚动角自由度是欠驱动的。非线性动力学方程(1)适用于前后轮转向,前后轮驱动的二轮转向、二轮驱动单轨车辆。它同时适用于处于行驶或者处于停车状态的车辆。因为前轮的角速度可以是正的或者是负的,它也没有限制车辆是在前进或者是后退。
二轮转向、二轮驱动单轨车辆是一个欠驱动系统。车辆的四个自由度中,只有前轮转向角、前轮转动角和后轮转向角三个自由度是主动控制的。车身滚动角,也叫车身倾斜角,是没有驱动机制的。
二轮转向的单轨车辆的动力学和前轮转向的动力学有一个很大的差别,它不仅多了一个自由度,动力学方程的非线性系数从39个增加到84个,双轮转向的单轨车辆还是一个变系统:车轮产生的4个非完全约束方程在前轮和后轮转弯角为90度时,系统丢失掉一个约束方程、使得前轮和后轮可以不受约束的转动。这个时候系统的状态不再可以使用车身滚动角,前轮转向角、后轮转向角和前轮转动角来代表。系统必须用车身滚动角、前轮转动角、后轮转动角来代表。这个时候系统不仅少了一个自由度、它的系统描述变量也不一样。它的动力学可以用以下方程代表:
其中
变系统的非线性欠驱动系统控制方法有很多,最主要的非线性最优控制(Nonlinear Optimal Control)、部分反馈线性化(partial feedback linearization)、神经网络控制(Neural Network Control),基于能量的控制(Energy Based Control)和滑模控制(Sliding Mode Control)。它们都需要精确的车辆非线性动力学建模。
这里我们使用非线性最优控制来说明本发明的方法。非线性最优控制是上世纪60-70年代发展成熟的控制方法,最早用于火箭飞行控制。给出系统的花费函数(costfunction),非线性最优控制计算出最优控制量u*(t)和状态x*(t)随时间的推移,在满足非线性动力学方程(1)的约束下,使得花费函数最小:
其中,J为系统花销。x(t0)为车辆在起点位置时的状态,x(tf)为车辆在终点位置时的状态,t0为起点时间,tf为终点时间。其中,状态是指车辆行驶状态。
并满足一阶动力学方程约束
路径约束
p[x(t),u(t),t]≥0, (4)
其中,函数P代表路径约束函数。
和边条件约束
b[x(t0),t0,x(tf),tf]=0. (5)
其中,函数b代表边条件约束函数。
利用数值迭代方法,可以计算出非线性方程的解:最优控制量u*(t),就是本系统的前轮驱动和刹车力矩、前轮转向电机力矩、后轮驱动和刹车力矩,以及后轮转向电机力矩。车辆状态x*(t),就是车辆位置,车身滚动角、前轮转向角、前轮转动角、后轮转弯角,后轮转动角分别随时间的函数:
u=u*(t) (6)
x=x*(t) (7)
目前高效率的数值方法有伪频谱方法(pseudospectrum)求解非线性最优控制。非线性最优控制的解和目前的车辆位置,车身滚动角、前轮转向角、前轮转动角、后轮转向角有关,也和车辆需要达到的位置、车身滚动角、车轮转向角、前轮转动角有关。最优控制方法根据车辆的目前状态和用户的要求,计算出车辆的最优控制量(6)和车辆的最优状态(7)。这个过程叫前馈。它是没有反馈的。
实际上车辆的建模误差、外部的扰动以及车辆参数的变化都会使得车辆偏移最优状态。本发明设计了线性反馈系统,消除误差和扰动,增加了系统的稳定性。假设在t时刻,车辆实际的状态为x(t),它与最优控制状态之差为dx:
dx(t)=x(t)-x*(t). (8)
通常车辆状态和最优控制的车辆状态差别很小,dx为小量、最优控制量修正du也是小量。可以证明dx和du满足线性二次型控制:
其中,Q、R为权重因子,为定值,S(f)为终点条件,如位置、车身滚动角、前轮轮转向角、前轮转动角和后轮转向角等。
动力学方程约束也是在最优控制解附近的线性移展开:
A、B矩阵为非线性动力学方程在最优解x*(t)附近的泰勒展开。最优反馈控制和车辆状态有关:
du(t)=-K(t)·dx(t)
其中K矩阵为反馈矩阵,K(t)=R-1BTS(t),S(t)是微分黎卡提方程(differentialRiccati equation)的解:
黎卡提方程是从未来解向当前时间,所以它的的初条件是在最终时间确定的:
S(tf)=Sf (12)
通过上述计算,就可以计算出最优控制量u*(t),就是本系统的前轮驱动和刹车力矩、前轮转向电机力矩、后轮转向电机力矩和后轮驱动和刹车力矩,通过前轮驱动和刹车力矩、前轮转向电机力矩、后轮转向电机力矩和后轮驱动和刹车力矩对车辆进行控制即可。
这样,控制系统可以拒绝扰动等偏差,使车辆系统稳定,同时预期达到用户指定的位置。
本发明可以用来实现二轮转向、二轮驱动单轨车辆的自动驾驶。也可以实现人工驾驶二轮转向、二轮驱动单轨车辆。在自动驾驶模式下,车辆的轨迹是由导航模块,摄像头和通信模块决定的,其中,导航模块,摄像头和通信模块都属于传感器子系统中的一部分。而在人工驾驶模式下,车辆的轨迹则由驾驶人决定。驾驶人可以使用电子方向盘、电子刹车踏板和电子加速踏板输入期望的车辆行驶方向和速度,嵌入式电脑根据驾驶人的输入和传感器测量值,计算出车辆的轨迹和控制输出,控制前轮驱动电机和前轮转向电机力矩、后轮转向电机和驱动电机力矩、以及前轮刹车和后轮刹车力矩在单轨车辆行驶和停止状态下,达到车辆的平衡。
需要说明的是,本发明和目前常用的单轨车辆控制方法有本质的区别:
现有技术的控制方法限定一些自由度、计算出一些控制信号。本发明使用动力学和现代控制方法,在不限制车辆的任何自由度情况下,计算出协同控制输出。本系统的控制信号u*(t)和du(t),同时具有前轮驱动电机和刹车的控制信号、也具有前轮转向电机的控制信号、后轮转向电机控制信号、后轮驱动电机和刹车的控制信号。这些信号同时共同作用的,使得车辆平衡稳定地达到用户需要的状态和目的地。
可选的,在上述任一实施例的基础上,嵌入式电脑用于根据车辆行驶状态和行驶目标数据,计算得到协同的电机驱动信号时,具体用于:
S11、根据行驶目标数据,计算得到驾驶人的意愿路径;
具体的,根据行驶目标数据,嵌入式电脑能够推测出车辆的驾驶人的意愿路径,即能够推测出用户的下一行驶位置。其中,意愿路径可以是下一10s所行驶的路径。
其中,行驶目标数据包括驾驶人输入的方向盘信息、刹车踏板信息和油门踏板信息;
本实施例适用于人工驾驶二轮转向、二轮驱动单轨车辆,人工驾驶时,人工会控制电子刹车踏板、电子加速踏板和电子方向盘。嵌入式电脑能够接收到人工输入的电子刹车踏板的深度值、电子加速踏板的深度值和电子方向盘的转动值。
S12、根据传感器子系统采集的车辆行驶状态以及意愿路径,计算得到前轮转向电机驱动器、前轮驱动电机驱动器、前轮刹车驱动器、后轮转向电机驱动器、后轮驱动电机驱动器和后轮刹车驱动器的控制信号。
具体的,将车辆行驶状态、以及意愿路径代入到非线性变系统动力学模型和非线性控制模型,即可计算出前轮转向电机驱动器、前轮驱动电机驱动器、前轮刹车驱动器的控制信号、后轮转向电机驱动器、后轮驱动电机驱动器和后轮刹车驱动器的控制信号。此外,还可以计算得到车身滚动角、车身偏航角、前轮转向角、后轮转向角随时间变化的曲线,其中,前轮转向电机驱动器、前轮驱动电机驱动器、前轮刹车驱动器的控制信号、后轮转向电机驱动器、后轮驱动电机驱动器和后轮刹车驱动器的控制信号也为随时间变化的曲线。
其中,本实施例中,意愿路径只是当前时间的下一个预设时间内的意愿路径,其中,预设时间可以是10s,具体的,假设车辆从起始地A行驶到目的地B,此时,如果计算出整个路程的意愿路径,由于车辆在整个行驶路程中可能会遇到石头等障碍物或者其他路况,进而就导致车辆不能按照意愿路径进行行驶,此时得到的意愿路径就不再有意义,需要重新计算得到新的意愿路径,所以计算出整个路程的意愿路径是不可取的,因此,本实施例采用仅计算10s的意愿路径,当这个10s的意愿路径行走完时,再计算下一个10s的意愿路径。
需要说明的是,计算得到前轮转向电机驱动器、前轮驱动电机驱动器、前轮刹车驱动器、后轮转向电机驱动器、后轮驱动电机驱动器和后轮刹车驱动器的控制信号后,由于车辆的实际运行状态与目标行驶状态是有差距的,如行驶目标数据中的转向角为30度,而车辆的实际运行状态信息中的转向角为28度,由于行驶目标数据中的数值是车辆在保持平衡下的最优的行驶状态,即需要对二轮转向、二轮驱动单轨车辆的状态和目标数据进行线性修正。即,虽然按照意愿路径进行控制,但是由于车辆受到外界环境的影响,如遇到石头等障碍物,或者遇到大风等情况,会使车辆的行驶状态改变,进而需要对车辆的行驶状态进行修正。
即嵌入式电脑用于对计算得到的协同的电机驱动信号进行修正,得到修正后的电机驱动信号时,具体用于:
通过传感器子系统实时采集的二轮单轨车辆的车辆行驶状态和行驶目标数据的比对结果,对计算得到的协同的电机驱动信号进行修正,得到修正后的电机驱动信号。
将传感器子系统实时采集的二轮单轨车辆的车辆行驶状态和行驶目标数据根据公式8-12、非线性变系统动力学模型和非线性控制模型,即得到修正后的电机驱动信号。
其中,修正后的电机驱动信号包括:
前轮转向电机驱动器、前轮驱动电机驱动器、前轮刹车驱动器、后轮转向电机驱动器、后轮驱动电机驱动器和后轮刹车驱动器的控制信号的修正值。
进而按照前轮转向电机驱动器、前轮驱动电机驱动器、前轮刹车驱动器、后轮转向电机驱动器、后轮驱动电机驱动器和后轮刹车驱动器的控制信号的修正值,调整前轮转向电机驱动器、前轮驱动电机驱动器和前轮刹车驱动器、后轮转向电机驱动器、后轮驱动电机驱动器和后轮刹车驱动器的输出信号,以使车辆按照意愿路径动态平衡行驶。
本实施例中,提供了一种人工驾驶二轮转向、二轮驱动单轨车辆的控制方式,进而能够按照本方式对二轮转向、二轮驱动单轨车辆进行控制,以达到动态平衡。
可选的,在图2对应实施例的基础上,嵌入式电脑用于根据车辆行驶状态和行驶目标数据,计算得到协同的电机驱动信号时,具体用于:
根据行驶目标数据以及传感器子系统采集的车辆行驶状态,计算得到前轮转向电机驱动器、前轮驱动电机驱动器、前轮刹车驱动器、后轮转向电机驱动器、后轮驱动电机驱动器和后轮刹车驱动器的控制信号。
具体的,本发明既适用于自动驾驶二轮转向、二轮驱动单轨车辆,也适用于人工驾驶二轮转向、二轮驱动单轨车辆。本实施例中介绍的是将本发明应用于自动驾驶二轮转向、二轮驱动单轨车辆。
行驶目标数据可以是外接设备输入的,其中,行驶目标数据可以是10s的一段路程的行驶目标数据。此外,还可以采用人工语音输入行驶目标数据的方式输入行驶目标数据。
然后,将行驶目标数据以及传感器子系统采集的车辆行驶状态代入到非线性变系统动力学模型和非线性控制模型中,计算得到前轮转向电机驱动器、前轮驱动电机驱动器、前轮刹车驱动器、后轮转向电机驱动器、后轮驱动电机驱动器和后轮刹车驱动器的控制信号。此外,还可以计算到车身滚动角、车身偏航角、前轮转向角、后轮转向角的变化曲线,其中,前轮转向电机驱动器、前轮驱动电机驱动器和前轮驱动器、后轮转向电机驱动器、后轮驱动电机驱动器和后轮刹车驱动器的控制信号也为随时间变化的曲线。
需要说明的是,本实施例中,也需要对前轮转向电机驱动器、前轮驱动电机驱动器和前轮刹车驱动器、后轮转向电机驱动器、后轮驱动电机驱动器和后轮刹车驱动器的控制信号进行修正,具体修正过程参照人工驾驶二轮转向、二轮驱动单轨车辆中的修正过程,在此不再赘述。
本实施例中,提供了一种自动驾驶二轮转向、二轮驱动单轨车辆的控制方式,进而能够按照本方式对二轮转向、二轮驱动单轨车辆进行控制,以达到动态平衡。
本发明中,车辆在非零速度行驶时,本控制系统自动加强车辆前轮和后轮转向电机力矩τ2和τ3的控制,使得前轮和者后轮车轮转向角可以有效地调节车身重心相对前后轮横向位置。在正常行驶时,可以实现有效实现车辆的稳定平衡。
在车辆处于低速度或者是停止不动时,车辆前轮或者后轮车轮转向角不能调节车辆重心相对位置。但是前后轮同时驱动时,在固定的大前后轮转向角下,前后移动车辆可以调节车辆重心相当于车轮支撑点的相对位置。本发明的控制系统自动加强对前轮和后轮的驱动电机力矩控制,调节的前轮和/或后轮驱动电机力矩τ1,τ3实现车辆的稳定平衡。通常车辆是在大车轮转向角下(比如+-45度以上,甚至+-90度),车辆前轮或者后轮驱动电机快速前后微小调节车辆的位置。本发明的非线性动力学模型计算表明,当车轮转向角等于90度时,K33=0。这是因为车轮转向角在90度时,如果前轮不打滑,后轮是不能驱动车辆前进的,因而不能用来控制车辆的平衡。当使用前轮和后轮来控制车辆平衡,嵌入式电脑必须可以指令前轮和后轮驱动电机正向和反向的快速切换。这个指令是在非零速度行驶的单轨车辆自动控制中没有的。电脑控制的自动平衡系统把前轮转向和后轮转向角固定在90度或者是-90度,根据传感器测量的信息和控制算法,快速调节前轮驱动电机和后轮驱动电机使得车身做微小的左右移动,达到自动平衡的目的。
在车辆起步或者是停车时,本发明的控制方法平稳地在两个控制模式上切换。安装非线性控制模型的嵌入式电脑,只要可以控制前轮转向电机和后轮转向电机,就可以在车辆行驶时,保持车辆平衡。同时,只要可以控制安装在前轮,或者后轮上的驱动电机,就可以在车辆停止的状态下保持车辆的稳定平衡。即使是在外界扰动的,比如阵风或者是外力的冲击车辆,偏离平衡状态下,嵌入式电脑依然可以调节车辆驱动电机,修正车辆的车身滚动角,把车辆带到平衡状态下。
前轮或者后轮驱动的单轨车辆容易在潮湿的地面上打滑、安全性不能保障。它也不能越野,限制了它的应用范围。前轮转向的单轨车辆静态和动态的稳定性也比较差。在外力横向冲击下,前轮驱动、前轮转向的单轨车辆只能通过前轮驱动电机和前轮转向电机调节。后轮由于没有转向电机,不能有效参与抗冲击的控制。前轮转向的单轨车辆转弯半径也比较大、不合适在狭小的空间转弯。本发明提供的二轮转向、二轮驱动的自动平衡单轨车辆还可以大大提高防滑、越野和抗冲击能力。本发明的二轮转向车辆,可以在很窄的空间转向和调头。本发明可以大大提高单轨车辆的安全性、实用性和应用范围。
为了本领域的技术人员清楚明白的了解本发明,现以人工驾驶和自动驾驶车辆两个例子进行解释说明。
(1)人工驾驶二轮转向、二轮驱动单轨车辆
本实施例提供的二轮转向、二轮驱动单轨车辆的主要组成部分包括:斜长的车身,安装在车身前部的带转向电机、驱动电机和刹车的前轮,安装在车后部的带转向电机、驱动电机和刹车的后轮,多个传感器(包括光编码器和惯性传感器),电子记录仪,带控制软件的嵌入式电脑,和控制转向电机,驱动电机、前后轮刹车的驱动器构成。车身可以是带门,座椅的全封闭式的单元,以及车身内驾驶人电子控制输入、和显示车辆实际行驶状态信息的电子显示单元。
驾驶人可以加入车辆内部,在座椅上坐下以后,启动控制系统。嵌入式电脑启动后,传感器开始采集车辆的车辆行驶状态,驾驶人踩下电子加速踏板,嵌入式电脑根据驾驶人输入的油门和方向盘数据,计算出前轮驱动电机、前轮转向电机、后轮驱动电机和后轮转向电机的控制信号,指令电机的转矩和转动方向,在平衡车辆的同时,达到驾驶人需要的车辆速度和车辆行驶方向。嵌入式电脑持续利用传感器采集的车辆行驶状态和驾驶人的输入信号,重复修正车辆需要到达的状态和位置,连续调整前轮和后轮转向电机的力矩,让车辆稳定行驶。
当驾驶人踩下电子刹车踏板时,嵌入式电脑及时更新车辆的状态,利用非线性变系统动力学模型和非线性控制模型,计算出最优的前后轮刹车力矩,和转向电机力矩,在保持车辆平衡的条件下,安全快捷的减低车辆速度。当速度减低到一个阈值时,嵌入式电脑自动切换到准静态控制模式,在固定一个非0的前轮转向角和后轮转向角下,放松电子刹车,调节前轮驱动电机和后轮驱动的力矩和转动方向,达到准静态平衡。这种控制方法适用于暂时停车。
当驾驶人踩下电子加速踏板后,嵌入式电脑更新车辆的状态,调节前轮转向和后轮转向电机,不再调节驱动力矩的方向,增加驱动电机的正向力矩,驱动车辆前进。
驾驶人可以通过电子LCD显示屏,了解车辆的行驶状态。利用电子方向盘控制车辆的方向,利用电子刹车踏板和电子油门踏板控制车辆的速度。
(2)自动驾驶二轮转向、二轮驱动单轨车辆
可以采用机器自动驾驶二轮转向、二轮驱动单轨车辆。车辆平衡的控制系统的组成部分包括:斜长的车身,安装在车身前部的带转向电机和驱动电机的前轮,安装在车后部的带转向电机和驱动电机的后轮,通信模块,导航模块,多个传感器(包括光编码器、惯性传感器和视频采集传感器),电子记录仪,带控制软件的嵌入式电脑,和控制转向电机,驱动电机的输出构成。斜长的车身可以运送人员或者货物。
自动驾驶单轨车辆,根据用户输入信息,或者是远端自动驾驶服务器通过通信模块发来的目的地和路径信息,规划出最佳路径,车辆传感器测量车辆的车辆行驶状态,嵌入式电脑计算出前轮转向电机、前轮驱动电机的控制信号、后轮转向电机和后轮驱动电机的控制信号,指令车辆运行。视频采集传感器提供路况3D实时信息,时刻发现规划路径上的障碍物信息。嵌入式电脑根据这些信息,重新规划路径,或者命令车辆停止运行,通信模块发送车辆和路况信息给远端自动驾驶服务器。当视频采集传感器探测到障碍物消失已经,嵌入式电脑再重新启动车辆,驶向目的地。
可选的,本发明的另一实施例中提供了一种二轮单轨车辆平衡的控制方法,应用于二轮单轨车辆,参照图4,包括:
S21、传感器子系统采集二轮单轨车辆的车辆行驶状态和行驶目标数据;
S22、嵌入式电脑根据车辆行驶状态和行驶目标数据,计算得到协同的电机驱动信号,对计算得到的协同的电机驱动信号进行修正,得到修正后的电机驱动信号,输出修正后的电机驱动信号到电机驱动子系统;
S23、电机驱动子系统根据修正后的电机驱动信号中的每个信号控制相应的电机的力矩输出,使得二轮单轨车辆达到动态平衡、并按照行驶目标数据规划行驶。
可选的,在本实施例的基础上,嵌入式电脑根据车辆行驶状态和行驶目标数据,计算得到协同的电机驱动信号,包括:
根据车辆行驶状态和行驶目标数据,基于非线性变系统动力学模型和非线性控制模型,计算得到协同的电机驱动信号。
可选的,在本实施例的基础上,电机驱动子系统根据修正后的电机驱动信号中的每个信号控制相应的电机的力矩输出,包括:
前轮转向电机驱动器根据修正后的电机驱动信号中的前轮转向驱动信号,控制前轮转向电机的力矩输出;
前轮驱动电机驱动器根据修正后的电机驱动信号中的前轮驱动信号,控制前轮驱动电机的力矩输出;
前轮刹车驱动器根据修正后的电机驱动信号中的前轮刹车驱动信号,控制前轮刹车电机的力矩输出;
后轮转向电机驱动器根据修正后的电机驱动信号中的后轮转向驱动信号,控制后轮转向电机的力矩输出;
后轮驱动电机驱动器根据修正后的电机驱动信号中的后轮驱动信号,控制后轮驱动电机的力矩输出;
后轮刹车驱动器根据修正后的电机驱动信号中的后轮刹车驱动信号,控制后轮刹车电机的力矩输出。
可选的,在本实施例的基础上,嵌入式电脑对计算得到的协同的电机驱动信号进行修正,得到修正后的电机驱动信号,包括:
通过传感器子系统实时采集的二轮单轨车辆的车辆行驶状态和行驶目标数据的比对结果,对计算得到的协同的电机驱动信号进行修正,得到修正后的电机驱动信号。
本实施例中,嵌入式电脑根据车辆行驶状态和行驶目标数据,计算得到协同的电机驱动信号,对计算得到的协同的电机驱动信号进行修正,得到修正后的电机驱动信号,输出修正后的电机驱动信号到电机驱动子系统后,电机驱动子系统,用于根据协同的电机驱动信号中的每个信号控制相应的电机的力矩输出,使得二轮单轨车辆达到动态平衡、并按照行驶目标数据规划行驶。这种方法不对车辆的状态进行限定,即车辆无论是处于停止状态,行驶状态,或者是停车状态和行驶状态之间的相互切换状态时,均能够保证车辆动态平衡行驶,解决了现有的自动控制平衡的二轮单轨车辆,在车辆从停车状态到行驶状态或者是从行驶状态到停车状态时,不能自动保持动态平衡的问题。
需要说明的是,本实施例中的步骤的具体解释说明,请参照上述实施例中的相应说明。
可选的,在上述任一控制方法的实施例的基础上,嵌入式电脑根据车辆行驶状态和行驶目标数据,计算得到协同的电机驱动信号,包括:
根据行驶目标数据,计算得到驾驶人的意愿路径;其中,行驶目标数据包括驾驶人输入的方向盘信息、刹车踏板信息和油门踏板信息;
根据传感器子系统采集的车辆行驶状态以及意愿路径,计算得到前轮转向电机驱动器、前轮驱动电机驱动器、前轮刹车驱动器、后轮转向电机驱动器、后轮驱动电机驱动器和后轮刹车驱动器的控制信号。
本实施例中,提供了一种人工驾驶二轮单轨车辆的控制方式,进而能够按照本方式对二轮单轨车辆进行控制,以达到动态平衡。
需要说明的是,本实施例中的步骤的具体解释说明,请参照上述实施例中的相应说明。
可选的,在上述图4对应的实施例的基础上,嵌入式电脑根据车辆行驶状态和行驶目标数据,计算得到协同的电机驱动信号,包括:
根据行驶目标数据以及传感器子系统采集的车辆行驶状态,计算得到前轮转向电机驱动器、前轮驱动电机驱动器、前轮刹车驱动器、后轮转向电机驱动器、后轮驱动电机驱动器和后轮刹车驱动器的控制信号。
本实施例中,提供了一种自动驾驶二轮单轨车辆的控制方式,进而能够按照本方式对二轮单轨车辆进行控制,以达到动态平衡。
需要说明的是,本实施例中的步骤的具体解释说明,请参照上述实施例中的相应说明。
对所公开的实施例的上述说明,使本领域专业技术人员能够实现或使用本发明。对这些实施例的多种修改对本领域的专业技术人员来说将是显而易见的,本文中所定义的一般原理可以在不脱离本发明的精神或范围的情况下,在其它实施例中实现。因此,本发明将不会被限制于本文所示的这些实施例,而是要符合与本文所公开的原理和新颖特点相一致的最宽的范围。
Claims (12)
1.一种二轮单轨车辆,其特征在于,包括车身、安装在车身前部的可转向的前轮、安装在车后部的可转向后轮、传感器子系统、嵌入式电脑和电机驱动子系统;其中,所述电机驱动子系统包括前轮转向电机驱动器、前轮驱动电机驱动器、前轮刹车驱动器、后轮转向电机驱动器、后轮驱动电机驱动器和后轮刹车驱动器构成;
所述传感器子系统,用于采集二轮单轨车辆的车辆行驶状态和行驶目标数据;
所述嵌入式电脑,用于在车辆处于停止状态、行驶状态或者是停止状态和行驶状态之间的相互切换状态时,根据所述车辆行驶状态和所述行驶目标数据,计算得到协同的电机驱动信号,对计算得到的协同的电机驱动信号进行修正,得到修正后的电机驱动信号,输出修正后的电机驱动信号到电机驱动子系统;
所述电机驱动子系统,用于根据修正后的电机驱动信号中的每个信号控制相应的电机的力矩输出,使得二轮单轨车辆达到动态平衡、并按照行驶目标数据规划行驶;
其中,在车辆处于停止状态下,所述嵌入式电脑控制前轮转向电机和后轮转向电机使得车辆固定于预设转向角,然后持续控制前轮驱动电机和后轮驱动电机的力矩的方向和大小,达到准静态平衡。
2.根据权利要求1所述的二轮单轨车辆,其特征在于,所述嵌入式电脑用于根据所述车辆行驶状态和所述行驶目标数据,计算得到协同的电机驱动信号时,具体用于:
根据所述车辆行驶状态和所述行驶目标数据,基于非线性变系统动力学模型和非线性控制模型,计算得到协同的电机驱动信号。
3.根据权利要求1所述的二轮单轨车辆,其特征在于,所述嵌入式电脑用于根据所述车辆行驶状态和所述行驶目标数据,计算得到协同的电机驱动信号时,具体用于:
根据所述行驶目标数据,计算得到驾驶人的意愿路径;其中,所述行驶目标数据包括驾驶人输入的方向盘信息、刹车踏板信息和油门踏板信息;
根据所述传感器子系统采集的车辆行驶状态以及所述意愿路径,计算得到前轮转向电机驱动器、前轮驱动电机驱动器、前轮刹车驱动器、后轮转向电机驱动器、后轮驱动电机驱动器和后轮刹车驱动器的控制信号。
4.根据权利要求1所述的二轮单轨车辆,其特征在于,所述嵌入式电脑用于根据所述车辆行驶状态和所述行驶目标数据,计算得到协同的电机驱动信号时,具体用于:
根据所述行驶目标数据以及所述传感器子系统采集的车辆行驶状态,计算得到前轮转向电机驱动器、前轮驱动电机驱动器、前轮刹车驱动器、后轮转向电机驱动器、后轮驱动电机驱动器和后轮刹车驱动器的控制信号。
5.根据权利要求3所述的二轮单轨车辆,其特征在于,所述嵌入式电脑用于对计算得到的协同的电机驱动信号进行修正,得到修正后的电机驱动信号时,具体用于:
通过所述传感器子系统实时采集的二轮单轨车辆的车辆行驶状态和所述行驶目标数据的比对结果,对计算得到的协同的电机驱动信号进行修正,得到修正后的电机驱动信号。
6.根据权利要求1所述的二轮单轨车辆,其特征在于,所述电机驱动子系统用于根据修正后的电机驱动信号中的每个信号控制相应的电机的力矩输出时,具体用于:
所述前轮转向电机驱动器根据所述修正后的电机驱动信号中的前轮转向驱动信号,控制前轮转向电机的力矩输出;
所述前轮驱动电机驱动器根据所述修正后的电机驱动信号中的前轮驱动信号,控制前轮驱动电机的力矩输出;
所述前轮刹车驱动器根据所述修正后的电机驱动信号中的前轮刹车驱动信号,控制前轮刹车电机的力矩输出;
所述后轮转向电机驱动器根据所述修正后的电机驱动信号中的后轮转向驱动信号,控制后轮转向电机的力矩输出;
所述后轮驱动电机驱动器根据所述修正后的电机驱动信号中的后轮驱动信号,控制后轮驱动电机的力矩输出;
所述后轮刹车驱动器根据所述修正后的电机驱动信号中的后轮刹车驱动信号,控制后轮刹车电机的力矩输出。
7.一种二轮单轨车辆平衡的控制方法,其特征在于,应用于二轮单轨车辆,包括:
传感器子系统采集二轮单轨车辆的车辆行驶状态和行驶目标数据;
在车辆处于停止状态、行驶状态或者是停止状态和行驶状态之间的相互切换状态时,嵌入式电脑根据所述车辆行驶状态和所述行驶目标数据,计算得到协同的电机驱动信号,对计算得到的协同的电机驱动信号进行修正,得到修正后的电机驱动信号,输出修正后的电机驱动信号到电机驱动子系统;
电机驱动子系统根据修正后的电机驱动信号中的每个信号控制相应的电机的力矩输出,使得二轮单轨车辆达到动态平衡、并按照行驶目标数据规划行驶;
其中,在车辆处于停止状态下,所述嵌入式电脑控制前轮转向电机和后轮转向电机使得车辆固定于预设转向角,然后持续控制前轮驱动电机和后轮驱动电机的力矩的方向和大小,达到准静态平衡。
8.根据权利要求7所述的控制方法,其特征在于,所述嵌入式电脑根据所述车辆行驶状态和所述行驶目标数据,计算得到协同的电机驱动信号,包括:
根据所述车辆行驶状态和所述行驶目标数据,基于非线性变系统动力学模型和非线性控制模型,计算得到协同的电机驱动信号。
9.根据权利要求7所述的控制方法,其特征在于,所述嵌入式电脑根据所述车辆行驶状态和所述行驶目标数据,计算得到协同的电机驱动信号,包括:
根据所述行驶目标数据,计算得到驾驶人的意愿路径;其中,所述行驶目标数据包括驾驶人输入的方向盘信息、刹车踏板信息和油门踏板信息;
根据所述传感器子系统采集的车辆行驶状态以及所述意愿路径,计算得到前轮转向电机驱动器、前轮驱动电机驱动器、前轮刹车驱动器、后轮转向电机驱动器、后轮驱动电机驱动器和后轮刹车驱动器的控制信号。
10.根据权利要求7所述的控制方法,其特征在于,所述嵌入式电脑根据所述车辆行驶状态和所述行驶目标数据,计算得到协同的电机驱动信号,包括:
根据所述行驶目标数据以及所述传感器子系统采集的车辆行驶状态,计算得到前轮转向电机驱动器、前轮驱动电机驱动器、前轮刹车驱动器、后轮转向电机驱动器、后轮驱动电机驱动器和后轮刹车驱动器的控制信号。
11.根据权利要求9所述的控制方法,其特征在于,所述嵌入式电脑对计算得到的协同的电机驱动信号进行修正,得到修正后的电机驱动信号,包括:
通过所述传感器子系统实时采集的二轮单轨车辆的车辆行驶状态和所述行驶目标数据的比对结果,对计算得到的协同的电机驱动信号进行修正,得到修正后的电机驱动信号。
12.根据权利要求7所述的控制方法,其特征在于,所述电机驱动子系统根据修正后的电机驱动信号中的每个信号控制相应的电机的力矩输出,包括:
所述前轮转向电机驱动器根据所述修正后的电机驱动信号中的前轮转向驱动信号,控制前轮转向电机的力矩输出;
所述前轮驱动电机驱动器根据所述修正后的电机驱动信号中的前轮驱动信号,控制前轮驱动电机的力矩输出;
所述前轮刹车驱动器根据所述修正后的电机驱动信号中的前轮刹车驱动信号,控制前轮刹车电机的力矩输出;
所述后轮转向电机驱动器根据所述修正后的电机驱动信号中的后轮转向驱动信号,控制后轮转向电机的力矩输出;
所述后轮驱动电机驱动器根据所述修正后的电机驱动信号中的后轮驱动信号,控制后轮驱动电机的力矩输出;
所述后轮刹车驱动器根据所述修正后的电机驱动信号中的后轮刹车驱动信号,控制后轮刹车电机的力矩输出。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710810933.0A CN107618614B (zh) | 2017-09-11 | 2017-09-11 | 一种二轮单轨车辆及其平衡的控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710810933.0A CN107618614B (zh) | 2017-09-11 | 2017-09-11 | 一种二轮单轨车辆及其平衡的控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN107618614A CN107618614A (zh) | 2018-01-23 |
CN107618614B true CN107618614B (zh) | 2019-10-11 |
Family
ID=61089779
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710810933.0A Active CN107618614B (zh) | 2017-09-11 | 2017-09-11 | 一种二轮单轨车辆及其平衡的控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN107618614B (zh) |
Families Citing this family (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110077510B (zh) * | 2019-03-20 | 2024-03-29 | 广东工业大学 | 一种带有半自动驾驶功能的自平衡电动摩托车 |
CN110171518B (zh) * | 2019-05-27 | 2021-06-25 | 深圳傲科海科技有限公司 | 自平衡车控制系统及自平衡车 |
CN111268011B (zh) * | 2020-02-03 | 2021-03-16 | 腾讯科技(深圳)有限公司 | 自平衡车辆及其静态平衡控制方法、装置、介质及设备 |
CN114684321A (zh) * | 2020-12-25 | 2022-07-01 | 株式会社岛野 | 人力驱动车的控制装置 |
Family Cites Families (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2990405B2 (ja) * | 1994-01-31 | 1999-12-13 | 本田技研工業株式会社 | 自動二輪車 |
US7275607B2 (en) * | 1999-06-04 | 2007-10-02 | Deka Products Limited Partnership | Control of a personal transporter based on user position |
US7006901B2 (en) * | 2002-11-18 | 2006-02-28 | Wang Everett X | Computerized automated dynamic control system for single-track vehicles |
WO2011101979A1 (ja) * | 2010-02-19 | 2011-08-25 | 三菱電機株式会社 | 操舵制御装置 |
CN102582738B (zh) * | 2011-12-01 | 2013-08-07 | 北京邮电大学 | 一种变结构自平衡两轮车 |
CN205273726U (zh) * | 2015-12-21 | 2016-06-01 | 昆山引强电子科技有限公司 | 一种自平衡和骑行两用的电动车 |
CN106741410B (zh) * | 2017-02-24 | 2019-07-12 | 宁波工程学院 | 两轮电动平衡车分级驱动信号生成方法 |
-
2017
- 2017-09-11 CN CN201710810933.0A patent/CN107618614B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN107618614A (zh) | 2018-01-23 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107600267B (zh) | 一种二轮单轨车辆及其平衡的控制方法 | |
CN107618614B (zh) | 一种二轮单轨车辆及其平衡的控制方法 | |
EP4068039A1 (en) | Method and apparatus for controlling lateral motion of self-driving vehicle, and self-driving vehicle | |
CN107792062B (zh) | 一种自动泊车控制系统 | |
CN102822046B (zh) | 车辆控制的装置和方法 | |
CN109969183A (zh) | 基于安全可控域的弯道跟车控制方法 | |
CN110780674A (zh) | 一种提高自动驾驶轨迹跟踪控制的方法 | |
US6879896B2 (en) | System and method for using vehicle operator intent to adjust vehicle control system response | |
CN103057436B (zh) | 一种基于多智能体的独立驱动电动汽车横摆力矩控制方法 | |
CN107042841A (zh) | 一种轮毂电机驱动电动汽车差动助力转向稳定性控制方法 | |
CN106476883A (zh) | 车辆的行驶控制装置 | |
CN103158700B (zh) | 用于机动车的侧风稳定的方法 | |
CN107697065B (zh) | 一种面向一般停车场景的自动泊车控制方法 | |
CN110329255A (zh) | 一种基于人机协同策略的车道偏离辅助控制方法 | |
CN103121451A (zh) | 一种弯路换道轨迹的跟踪控制方法 | |
WO2010023668A1 (en) | System and method for stabilizing a single-track vehicle | |
CN107490968A (zh) | 自动驾驶汽车的自适应分层递阶路径跟踪控制方法 | |
CN109094644A (zh) | 极限工况下的主动后轮转向与直接横摆力矩控制方法 | |
CN105644566B (zh) | 一种基于车联网的电动汽车辅助换道轨迹的跟踪方法 | |
CN110703775A (zh) | 一种基于改进人工势场的商用车车道保持路径规划方法 | |
JP2020015349A (ja) | 車両の進路制御方法 | |
CN116945832A (zh) | 车辆主动悬架与多轴转向系统的分层协同控制方法 | |
CN111444577A (zh) | 一种电动大客车自动避让方法 | |
Göhring | Controller architecture for the autonomous cars: Madeingermany and e-instein | |
CN109969165A (zh) | 考虑轮胎侧向力贡献的基于目标优化的转矩分配方法 |
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 | ||
GR01 | Patent grant | ||
GR01 | Patent grant |