CN101573250B - 行驶装置及其控制方法 - Google Patents

行驶装置及其控制方法 Download PDF

Info

Publication number
CN101573250B
CN101573250B CN2007800492790A CN200780049279A CN101573250B CN 101573250 B CN101573250 B CN 101573250B CN 2007800492790 A CN2007800492790 A CN 2007800492790A CN 200780049279 A CN200780049279 A CN 200780049279A CN 101573250 B CN101573250 B CN 101573250B
Authority
CN
China
Prior art keywords
posture
control
motor torque
instruction
angle
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.)
Expired - Fee Related
Application number
CN2007800492790A
Other languages
English (en)
Other versions
CN101573250A (zh
Inventor
石井真二
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Toyota Motor Corp
Original Assignee
Toyota Motor Corp
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Toyota Motor Corp filed Critical Toyota Motor Corp
Publication of CN101573250A publication Critical patent/CN101573250A/zh
Application granted granted Critical
Publication of CN101573250B publication Critical patent/CN101573250B/zh
Expired - Fee Related legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60LPROPULSION OF ELECTRICALLY-PROPELLED VEHICLES; SUPPLYING ELECTRIC POWER FOR AUXILIARY EQUIPMENT OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRODYNAMIC BRAKE SYSTEMS FOR VEHICLES IN GENERAL; MAGNETIC SUSPENSION OR LEVITATION FOR VEHICLES; MONITORING OPERATING VARIABLES OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRIC SAFETY DEVICES FOR ELECTRICALLY-PROPELLED VEHICLES
    • B60L15/00Methods, circuits, or devices for controlling the traction-motor speed of electrically-propelled vehicles
    • B60L15/20Methods, circuits, or devices for controlling the traction-motor speed of electrically-propelled vehicles for control of the vehicle or its driving motor to achieve a desired performance, e.g. speed, torque, programmed variation of speed
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B62LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
    • B62KCYCLES; CYCLE FRAMES; CYCLE STEERING DEVICES; RIDER-OPERATED TERMINAL CONTROLS SPECIALLY ADAPTED FOR CYCLES; CYCLE AXLE SUSPENSIONS; CYCLE SIDE-CARS, FORECARS, OR THE LIKE
    • B62K11/00Motorcycles, engine-assisted cycles or motor scooters with one or two wheels
    • B62K11/007Automatic balancing machines with single main ground engaging wheel or coaxial wheels supporting a rider
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
    • G05D1/08Control of attitude, i.e. control of roll, pitch, or yaw
    • G05D1/0891Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for land vehicles
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60LPROPULSION OF ELECTRICALLY-PROPELLED VEHICLES; SUPPLYING ELECTRIC POWER FOR AUXILIARY EQUIPMENT OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRODYNAMIC BRAKE SYSTEMS FOR VEHICLES IN GENERAL; MAGNETIC SUSPENSION OR LEVITATION FOR VEHICLES; MONITORING OPERATING VARIABLES OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRIC SAFETY DEVICES FOR ELECTRICALLY-PROPELLED VEHICLES
    • B60L2200/00Type of vehicles
    • B60L2200/16Single-axle vehicles
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60LPROPULSION OF ELECTRICALLY-PROPELLED VEHICLES; SUPPLYING ELECTRIC POWER FOR AUXILIARY EQUIPMENT OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRODYNAMIC BRAKE SYSTEMS FOR VEHICLES IN GENERAL; MAGNETIC SUSPENSION OR LEVITATION FOR VEHICLES; MONITORING OPERATING VARIABLES OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRIC SAFETY DEVICES FOR ELECTRICALLY-PROPELLED VEHICLES
    • B60L2220/00Electrical machine types; Structures or applications thereof
    • B60L2220/40Electrical machine applications
    • B60L2220/46Wheel motors, i.e. motor connected to only one wheel
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60LPROPULSION OF ELECTRICALLY-PROPELLED VEHICLES; SUPPLYING ELECTRIC POWER FOR AUXILIARY EQUIPMENT OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRODYNAMIC BRAKE SYSTEMS FOR VEHICLES IN GENERAL; MAGNETIC SUSPENSION OR LEVITATION FOR VEHICLES; MONITORING OPERATING VARIABLES OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRIC SAFETY DEVICES FOR ELECTRICALLY-PROPELLED VEHICLES
    • B60L2240/00Control parameters of input or output; Target parameters
    • B60L2240/10Vehicle control parameters
    • B60L2240/14Acceleration
    • B60L2240/18Acceleration lateral
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60LPROPULSION OF ELECTRICALLY-PROPELLED VEHICLES; SUPPLYING ELECTRIC POWER FOR AUXILIARY EQUIPMENT OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRODYNAMIC BRAKE SYSTEMS FOR VEHICLES IN GENERAL; MAGNETIC SUSPENSION OR LEVITATION FOR VEHICLES; MONITORING OPERATING VARIABLES OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRIC SAFETY DEVICES FOR ELECTRICALLY-PROPELLED VEHICLES
    • B60L2240/00Control parameters of input or output; Target parameters
    • B60L2240/10Vehicle control parameters
    • B60L2240/14Acceleration
    • B60L2240/20Acceleration angular
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60LPROPULSION OF ELECTRICALLY-PROPELLED VEHICLES; SUPPLYING ELECTRIC POWER FOR AUXILIARY EQUIPMENT OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRODYNAMIC BRAKE SYSTEMS FOR VEHICLES IN GENERAL; MAGNETIC SUSPENSION OR LEVITATION FOR VEHICLES; MONITORING OPERATING VARIABLES OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRIC SAFETY DEVICES FOR ELECTRICALLY-PROPELLED VEHICLES
    • B60L2240/00Control parameters of input or output; Target parameters
    • B60L2240/10Vehicle control parameters
    • B60L2240/26Vehicle weight
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60LPROPULSION OF ELECTRICALLY-PROPELLED VEHICLES; SUPPLYING ELECTRIC POWER FOR AUXILIARY EQUIPMENT OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRODYNAMIC BRAKE SYSTEMS FOR VEHICLES IN GENERAL; MAGNETIC SUSPENSION OR LEVITATION FOR VEHICLES; MONITORING OPERATING VARIABLES OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRIC SAFETY DEVICES FOR ELECTRICALLY-PROPELLED VEHICLES
    • B60L2240/00Control parameters of input or output; Target parameters
    • B60L2240/40Drive Train control parameters
    • B60L2240/42Drive Train control parameters related to electric machines
    • B60L2240/421Speed
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60LPROPULSION OF ELECTRICALLY-PROPELLED VEHICLES; SUPPLYING ELECTRIC POWER FOR AUXILIARY EQUIPMENT OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRODYNAMIC BRAKE SYSTEMS FOR VEHICLES IN GENERAL; MAGNETIC SUSPENSION OR LEVITATION FOR VEHICLES; MONITORING OPERATING VARIABLES OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRIC SAFETY DEVICES FOR ELECTRICALLY-PROPELLED VEHICLES
    • B60L2240/00Control parameters of input or output; Target parameters
    • B60L2240/40Drive Train control parameters
    • B60L2240/42Drive Train control parameters related to electric machines
    • B60L2240/423Torque
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60LPROPULSION OF ELECTRICALLY-PROPELLED VEHICLES; SUPPLYING ELECTRIC POWER FOR AUXILIARY EQUIPMENT OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRODYNAMIC BRAKE SYSTEMS FOR VEHICLES IN GENERAL; MAGNETIC SUSPENSION OR LEVITATION FOR VEHICLES; MONITORING OPERATING VARIABLES OF ELECTRICALLY-PROPELLED VEHICLES; ELECTRIC SAFETY DEVICES FOR ELECTRICALLY-PROPELLED VEHICLES
    • B60L2260/00Operating Modes
    • B60L2260/20Drive modes; Transition between modes
    • B60L2260/34Stabilising upright position of vehicles, e.g. of single axle vehicles
    • YGENERAL 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
    • Y02TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
    • Y02TCLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
    • Y02T10/00Road transport of goods or passengers
    • Y02T10/60Other road transportation technologies with climate change mitigation effect
    • Y02T10/64Electric machine technologies in electromobility
    • YGENERAL 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
    • Y02TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
    • Y02TCLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
    • Y02T10/00Road transport of goods or passengers
    • Y02T10/60Other road transportation technologies with climate change mitigation effect
    • Y02T10/72Electric energy management in electromobility

Abstract

本发明提供在有斜坡的路面也能够静止的行驶装置及其控制方法。在步骤S2中静止开关(SW)接通(ON)时,在步骤S4读入从开关接通时起的轮胎旋转角度变化值,计算姿势指令补正角度θadj。进而,在步骤S5中更新姿势指令角度,使θREFpitch=θREFpitch0+θadj。此外,在步骤S2中静止开关(SW)断开(OFF)时,在步骤S6中使姿势指令补正角度θadj为0。因而,θREFpitch=θREFpitch0。进而,在步骤S7中进行姿势控制运算,在步骤S8中输出马达转矩指令Tref。

Description

行驶装置及其控制方法
技术领域
本发明涉及适用于例如各自独立地被驱动的两个车轮平行地设置、以使得在两个车轮之间保持前后的稳定的方式被控制而行驶的车辆的行驶装置及其控制方法。详细而言,涉及在斜面等停车时,使装置不会发生意外的运动的行驶装置及其控制方法。
背景技术
在以往的行驶装置中,通过对应于支撑平台的斜度而移动接地组件,维持支撑平台相对于接地组件的平衡(例如参照专利文献1)。
此外,通过根据姿势传感器的输出对同轴配置的左右的驱动轮进行控制驱动,进行用于保持前后方向的平衡的姿势控制和行驶控制(例如参照专利文献2)。
然而,在上述技术中,都无法在倾斜路面静止,要与倾斜角成比例地提高速度而行驶。因此,在斜坡路面,需要通过人的操作来使其静止。此外,在坡道上无人乘车时无法自律(自动)保持姿势也成为问题。
专利文献1  日本特表2004-500271号公报
专利文献2  日本特开2004-074814号公报
发明内容
例如,作为用于人乘载而以二轮行驶的交通工具,本发明申请人在先提出了如下所述的行驶装置(日本特愿2005-117365号)。首先,使用图7A、B和图8对本发明申请人提出的同轴二轮车的一个实施方式进行说明。
如图7A、B所示,本发明申请人在先提出的同轴二轮车10具有平行地设置的两个车轮11L、11R,这两个车轮11L、11R分别由独立的马达12L、12R驱动。此外,这两个马达12L、12R由控制装置13控制其驱动。而且,由陀螺仪等构成的姿势传感器14连接于该控制装置13,根据来自该姿势传感器14的检测信号计算马达12L、12R的控制所需要的驱动转矩(马达转矩)的值。
另一方面,在车轮11L、11R的附近设置有表示驾驶者乘载的乘载部的一个具体例子的分离台15L、15R。该分离台15L、15R相互由连杆机构(未图示)保持为预定的姿势。此外,在分离台15L、15R的中间设置有向上方延伸的操纵杆16,在其基部设置有成为装置整体的驱动电力源的电池(蓄电池)17和横摇轴(ロ一ル軸,侧倾轴)角度检测器(参照图8)21。此外,在操纵杆16的上部设置有具备电力开关(动力开关)18的握持部19。
如图8所示,驾驶者20将两脚放在分离台15L、15R上并起立,握住操纵杆16的上部的握持部19,操作电力开关18和操纵杆16的横摇轴角度。该操作由横摇轴角度检测器21检测。此外,乘载于分离台15L、15R的驾驶者的重心位置由内置的压力传感器(未图示)检测。这些检测信号和来自图7所示的姿势传感器14的检测信号供给至控制装置13而控制同轴二轮车10的行驶。
此外,图9中以框图表示控制系统的构成。即,在该图9中,包括上述控制装置13和其外围电路的控制系统的构成由框图示出。
在该图9中,来自各种开关30的操作信号向中央控制装置31供给,由中央控制装置31形成左右的旋转角度指令信号θref1、θref2。这些旋转角度指令信号θref1、θref2分别向马达控制装置32L、32R供给。进而,由这些马达控制装置32L、32R形成的马达电流Im1、Im2分别向马达12L、12R供给。然后,这些马达12L、12R的旋转经由减速器33L、33R传递至车轮11L、11R。
另一方面,马达12L、12R的旋转角分别由检测器34L、34R检测。该检测出的旋转角度信号θm1、θm2分别向马达控制装置32L、32R供给并且向中央控制装置31供给,进行旋转角度指令信号θref1、θref2的反馈控制。进而,来自内置于分离台15L、15R的压力传感器35和横摇轴角度检测器(PM)21的检测信号向包括姿势传感器14的电路36供给,横摇轴角度检测信号PM、所形成的台姿势检测信号θ0(由θroll、θpitch、θyaw、ωroll、ωpitch、ωyaw构成)向控制装置13供给。
此外,图10中示意性地表示单轮模型的控制装置的具体构成。另外,实际的二轮车辆中,分离台的传感器共用。此外,在图示的模型中,连结于车轮的马达控制在各车轮中由独立的控制装置来控制。
在图10中,来自内置于台15的压力传感器(未图示)的压力检测信号PS1、2、3、4和来自包括陀螺仪传感器(gyro sensor)、加速度传感器的姿势传感器14的台姿势检测信号θ0向控制装置13内的姿势控制部31供给。而且,对这些检测信号PS1~4和θ0以及乘载者等发出的来自外部的台姿势指令信号θREFpitch、θREFyaw、ωREF pitch、ωREFyaw进行运算,将算出的旋转指令θref向马达控制部32供给。
此外,车轮11和马达12经由减速器33连接,旋转角检测器34设置于马达12。而且,来自旋转角检测器34的马达旋转角度位置信号θm向控制装置13内的马达控制部32供给。由此,根据上述的旋转指令θref形成的对马达12的驱动电流被反馈控制,车轮11的驱动稳定化。这样一来,车轮11被稳定地驱动,并且其驱动由来自压力传感器(未图示)的压力检测信号PS1~4、来自姿势传感器的检测信号θ0等进行控制。
另外,在图11中表示系统的相互的连接关系。在图11中,来自压力传感器35的压力检测信号PS1~4、来自操纵杆16的横摇轴角度器(电位计(ポテンシヨメ一タ,分压计))21的横摇轴角度检测信号PM向姿势传感器电路36供给。该姿势传感器电路36内置有陀螺仪传感器41和加速度传感器42。由此,从姿势传感器电路36取出压力检测信号PS1~4和横摇轴角度检测信号PM以及台姿势检测信号θ0。
这些压力检测信号PS1~4、横摇轴角度检测信号PM以及台姿势检测信号θ0向控制装置13内的中央控制装置43供给。此外,来自电力开关18的操作信号向中央控制装置43供给。由此,由中央控制装置43计算左右的车轮的旋转指令θref1、θref2,向马达控制部32L、32R供给。此外,来自各旋转检测器34L、34R的信号向马达控制部32L、32R供给,进行马达12L、12R的驱动。
此外,来自电池17的电力向电源电路44供给。来自该电源电路44的例如24V马达用电源向马达控制部32L、32R供给,例如5V控制用电源向姿势传感器电路36和中央控制装置43供给。另外,电源电路44中设置有电源开关45,控制对各部的电源的供给。这样一来,进行马达12L、12R的驱动,由这些马达12L、12R驱动车轮11L、11R,进行同轴二轮车10的行驶。
即,本发明的对象是如图7所示的二轮车,其特征在于:是将马达装入独立的各车轮,检测本体姿势而保持平衡的控制构造。该二轮车具有通过控制马达转矩而进行行驶控制的行驶机构和控制装置,在基部内置有陀螺仪传感器和加速度传感器,通过向车轮给与回转转矩,一边将基部俯仰角度、横摆角度(ヨ一角度)保持为由控制装置确定的稳定姿势,一边使得本体进行前进、后退、转弯行驶地,控制车辆。
但是,在如图7所示的具有由于平行连杆构造产生的横摇轴旋转自由度的车辆中,或者在也适合于一轮、三轮以上的交通工具的车辆中,通过按照倒立摆(倒立振子)的原理进行驱动的控制方法,无法在斜坡路面静止。此外,专利文献1、2中记载的技术,也无法在斜坡路面静止,要与倾斜角成比例地提高速度来行驶。因此,在斜坡路面需要通过人的操作使其静止,而且在坡路上没有人乘车时无法自律地保持姿势。
本申请是鉴于这些方面而做出的,所要解决的问题点是在以往的装置中无法在斜坡路面静止。此外,专利文献1、2中记载的技术,也无法在斜坡路面静止,要与倾斜角成比例地提高速度来行驶。因此,在斜坡路面需要通过人的操作使其静止,而且在坡路上没有人乘车时无法自律地保持姿势。
因此,在本发明中,设计出了下述控制,即,伺服马达的控制系统具有由倒立摆进行的控制和马达位置控制这双重的控制系统,并与由制动杆进行的制动相兼顾。由此,能够不依存于路面的斜度而自律地保持姿势而静止。因而,本发明提供在具有斜坡的路面也能够静止的行驶装置及其控制方法。
根据技术方案1、2、3的发明,通过进行下述控制,即,伺服马达的控制系统具有由倒立摆进行的控制和马达位置控制这双重的控制系统,并与由制动杆进行的制动相兼顾的控制,能够不依存于路面的斜度而自律地保持姿势而静止。
此外,根据技术方案1、4的发明,能够良好地进行通常的行驶模式下的控制。另外,根据技术方案1、5的发明,能够良好地进行非乘车时的牵引模式下的控制。
此外,根据技术方案1、6的发明,通过进行控制使得马达转矩τ0和车轮的滚动转矩τ1相平衡,能够不依存于路面的斜度而自律地保持姿势而静止。
此外,根据技术方案7、8、9的发明,通过进行下述控制,即,伺服马达的控制系统具有由倒立摆进行的控制和马达位置控制这双重的控制系统,并与由制动杆进行的制动相兼顾的控制,能够实现不依存于路面的斜度而自律地保持姿势而静止的控制方法。
此外,根据技术方案7、10的发明,能够实现良好地进行通常的形式模式下的控制的控制方法。另外,根据技术方案7、11的发明,能够实现良好地进行非乘车时的牵引模式下的控制的控制方法。
根据技术方案7、12的发明,通过进行控制使得马达转矩τ0和车轮的滚动转矩τ1相平衡,能够实现不依存于路面的斜度而自律地保持姿势而静止的控制方法。
由此,在以往的装置中,在斜坡路面无法静止。此外,专利文献1、2所记载的技术也无法在斜坡路面静止,要与倾斜角成比例地提高速度而行驶。因此,在斜坡路面需要通过人的操作使其静止,而且在坡路上没有人乘车时无法自律地保持姿势。对此,根据本发明,能够提供容易地消除这些问题点的手段。
附图说明
图1是应用了本发明所涉及的行驶装置及其控制方法的静止姿势控制用的构成的一个实施方式的框图。
图2是用于对其进行说明的图。
图3是用于对其进行说明的图。
图4是用于对其进行说明的图。
图5A是用于对其进行说明的图。
图5B是用于对其进行说明的图。
图6是用于对其动作进行说明的流程图。
图7A是表示本发明适用的行驶装置的一个实施方式的构成图。
图7B是表示本发明适用的行驶装置的一个实施方式的构成图。
图8是用于对其进行说明的图。
图9是用于对其进行说明的图。
图10是用于对其进行说明的图。
图11是用于对其进行说明的图。
符号说明
100姿势控制运算部
101稳定姿势角度指令的值θREFpitch0的设定部
102姿势角速度指令的值ωREFpitch的设定部
103、106加法器
104、107减法器
105、108控制器
109增益Kamp的放大器
110马达常数(Km)
114系统
119运算器
120开关
具体实施方式
即,本发明的行驶装置是是一边控制车轮的驱动一边进行行驶的行驶装置,具有:控制单元,其计算驱动车轮的马达转矩、生成马达转矩指令信号;检测单元,其检测通过生成的马达转矩指令信号驱动的车轮驱动系统的旋转角度变化值;姿势指令补正值计算单元,其用旋转角度变化值计算姿势指令补正值;乘载者输入姿势指令角度的操作单元;静止模式的选择开关;和判定有无乘载者的判定单元,控制单元,根据姿势指令角度和姿势指令补正值进行马达转矩的计算,当通过选择开关选择了静止模式时,进行将姿势指令补正值与姿势指令角度相加的控制。
此外,本发明的行驶装置的控制方法,是一边控制车轮的驱动一边进行行驶的行驶装置的控制方法,根据供给的旋转指令,计算马达转矩,生成马达转矩指令信号;检测通过生成的马达转矩指令信号驱动的车轮驱动系统的旋转角度变化值;根据从操作单元输入的姿势指令角度和用旋转角度变化值计算出的姿势指令补正值,进行马达转矩的计算;在选择了静止模式时,进行将姿势指令补正值与姿势指令角度相加的控制。
下面,参照附图对本发明进行说明。图1中用框图表示用于应用了本发明所涉及的行驶装置及其控制方法的静止姿势控制的构成的一个实施方式。
在图1中,姿势控制运算部100中具有例如稳定姿势角度指令的值θREFpitch0的设定部101和姿势角速度指令的值ωREFpitch的设定部102。而且,来自设定部101的值θREFpitch0通过加法器103、减法器104向控制器105供给,乘以系数Kp而向加法器106供给。此外,来自设定部102的值ωREFpitch通过减法器107向控制器108供给,乘以系数Kd而向加法器106供给。由此,从加法器106取出马达转矩指令Tref[Nm]。
进而,马达转矩指令Tref[Nm]向增益Kamp的放大器109供给,变换成马达电流Im[A],供给至马达。该马达由马达常数(Km)110表示。由此,从马达常数110取出马达转矩输出Tm[Nm]。该马达转矩输出Tm[Nm]输入到由乘载者和车辆构成的系统114。
从系统114检测出台姿势θ0,其中俯仰角速度ωpitch供给至减法器107而从值ωREFpitch中减去该值,俯仰角度θpitch供给至减法器104而从值θREFpitch中减去该值。
进而,从系统114检测出轮胎旋转角度θt。
轮胎旋转角度θt被供给至运算器119,乘以增益Ki而形成θadj。该值θadj通过开关120供给至加法器103,与来自设定部101的稳定姿势角度指令的值θREFpitch0相加。
于是,关于用于上述的静止姿势控制的构成,下面说明保持二轮车构造的角动量和地面压力以及ZMP(Zero Moment Point,零力矩点)中的平衡的姿势力学。
在图2所示的表示各力点的图中,如果将各连杆的重心位置坐标设为(xi、zi),则绕第i连杆的定义点Ω(σ、φ)的角动量能够计算为[数1]。
[数1]
Ii * ωi + mi * x · i ( φ - zi ) - mi * z · i ( σ - xi )
此外,由所有连杆的惯性力产生的力矩为
[数2]
Σ I = 0 n ( Ii * ωi · + mi * x · · i ( φ - zi ) - mi * z · · i ( σ - xi ) ) .
接下来,如果考虑由所有连杆的重力产生的力矩,则为
[数3]
Σ I = 0 n mi ( σ - xi ) g .
于是,通过它们之和,绕Ω的力矩由[数4]给出。
[数4]
MΩ = Σ I = 0 n Ii * ω · i + Σ i = 0 n mi ( x · · i ( φ - zi ) - z · · i ( σ - xi ) ) + Σ i = 0 n mi ( σ - xi ) g
进而,如果除去由车轮的质量m0的重力产生的力矩,则力矩成为绕车轮轴的力矩。如果将其设为Ma,则
[数5]
Ma = Σ I = 0 n Ii * ω · i + Σ i = 0 n mi ( z · · i * xi - x · · i * zi ) - Σ i = 0 n mi * xi * g .
此外,使用Ma表示先前的绕Ω的力矩MΩ,则得到下式。即,因为X0=0,所以成为下面的[数6]。
[数6]
MΩ = Ma - Σ I = 0 n mi ( z · · i - g ) σ + Σ i = 0 n mi * x · · i * φ
另一方面,如图3所示,ZMP是地面上的点,力矩MΩ被定义为零点。将车轮轴的高度设为h、ZMP的坐标设为(σzmp、-h)代入[数4],则得到
[数7]
0 = Σ i = 0 n Ii * ω · i + Σ i = 0 n mi ( - x · · i ( h + zi ) - z · · i ( σzmp - xi ) ) + Σ i = 0 n mi ( σzmp - xi ) g .
关于σzmp解出该式,则ZMP能够由连杆位置、加速度以及重力表示。此外,将ZMP的坐标代入[数6],则得到[数8]。
[数8]
0 = Ma - Σ i = 0 n mi ( z · · i - g ) σzmp - Σ i = 0 n mi * x · · i * h
在此,[数8]是绕车轮轴力矩的平衡式。即,F是地面反力(反作用力)和滚动摩擦力的矢量,FN是地面反力、FT是滚动摩擦力。反力实际上分布于轮胎底,但在图中总括地表示为作用于一点的点。这样表示的作用点是ZMP。
如果从该式表示绕车轮轴点的力矩的平衡,则成为
[数9]
FN*σzmp+FT*h+τ0=0,将
[数10]
τ 0 = Ma , FN = - Σ i = 0 n mi ( z · · i - g ) , FT = - Σ i = 0 n mi * x · · i
代入其中,则式9与式8相同。
另一方面,车轮上的姿势稳定的条件是满足σzmp=0的式9即可,所以如果τ0=-FT*h成立,则能够保持姿势。因而,通过控制满足τ0=FT=0的条件的[数11]的状态变量,能够使姿势稳定。
[数11]
( Xi , X · i , X · · i ) = ( 0 , 0 , 0 )
根据以上的原理,如图4、图5所示的斜坡路面上,轮胎接地点为图示的位置。为了在这样的接地状态下保持姿势,只要满足ZMP为轮胎接地点的关系即可。在此,如图4、图5所示那样倾斜的情况下,通过利用马达转矩τ0使ZMP为路面接地点,能够保持姿势。利用图1的静止姿势控制用的构成产生这样的马达驱动转矩。
即,如图4所示,在路面倾斜状态下,轮胎接地点位于重心矢量上时,该系统能够保持静止姿势。图5中表示实际的车辆在斜坡路面上时,通过由图1的控制将重心位置控制在轮胎接地点上,系统能够平衡而保持静止状态。
此外,在图6中,表示用于由图1的构成进行静止控制的动作的流程图。即,在图6所示的静止控制中,首先在步骤S1中设定控制参数。在此,根据系统重量,设定控制增益Kp、Ki。然后,在步骤S2中判断静止开关SW120是否接通。即,判断是否选择了静止控制。
当在步骤S2中静止开关SW接通(ON)时,在步骤S4中读入从开关接通时起的轮胎旋转角度变化值,计算姿势指令补正角度θadj。然后,在步骤S5中更新姿势指令角度,设为θREFpitch=θREFpitch0+θadj。
此外,当在步骤S2中静止开关SW断开(OFF)时,在步骤S6中使姿势指令补正角度θadj为0。因而,θREFpitch=θREFpitch0。然后,在步骤S7中进行姿势控制运算,在步骤S8中输出马达转矩指令Tref。接着,在步骤S9中发生姿势变化,返回至步骤S1。
因而,在上述的实施方式中,设计出了这样的控制,即,使伺服马达的控制系统具有利用倒立摆进行的控制和马达位置控制这双重的控制系统,并与由制动杆进行的制动兼顾的控制。由此,能够不依存于路面的斜度而自律地保持姿势而静止。因而,本发明提供即使在有斜度的路面也能够静止的行驶装置及其控制方法。
根据本发明的行驶装置,是一边控制车轮的驱动一边进行行驶的行驶装置,具有:控制单元,其计算驱动车轮的马达转矩、生成马达转矩指令信号;检测单元,其检测通过生成的马达转矩指令信号驱动的车轮驱动系统的旋转角度变化值;姿势指令补正值计算单元,其用旋转角度变化值计算姿势指令补正值;乘载者输入姿势指令角度的操作单元;静止模式的选择开关;和判定有无乘载者的判定单元,控制单元,根据输入于操作单元的姿势指令角度和由姿势指令补正值计算单元计算出的姿势指令补正值进行马达转矩的计算,当通过选择开关选择了静止模式时,进行将姿势指令补正值与姿势指令角度相加的控制,由此能够不依存于路面的斜度而自律地保持姿势而静止。
此外,本发明的行驶装置的控制方法,是一边控制车轮的驱动一边进行行驶的行驶装置的控制方法,根据供给的旋转指令,计算马达转矩,生成马达转矩指令信号;检测通过生成的马达转矩指令信号驱动的车轮驱动系统的旋转角度变化值;根据旋转角度变化值计算姿势指令补正值,根据输入于操作单元的姿势指令角度和计算出的姿势指令补正值,进行马达转矩的计算;在选择了静止模式时,进行将姿势指令角度与姿势指令补正值相加的控制。由此能够实现能够不依存于路面的斜度而自律地保持姿势而静止的控制方法。
另外,本发明不限定于上述说明的实施方式,只要不脱离本发明的主旨,能够进行各种变形。

Claims (5)

1.一种行驶装置,是一边控制车轮的驱动一边进行行驶的行驶装置,其特征在于,具有:
控制单元,其计算驱动车轮的马达转矩、生成马达转矩指令信号;
检测单元,其检测通过所述生成的马达转矩指令信号驱动的车轮驱动系统的旋转角度变化值;
姿势指令补正值计算单元,其用所述旋转角度变化值计算姿势指令补正值;以及
用于在斜坡路面静止的静止模式的选择开关,
所述控制单元,当通过所述选择开关选择了所述静止模式时,进行将所述姿势指令补正值与姿势指令角度相加的控制,当未选择所述静止模式时,将所述姿势指令补正值设定为0。
2.如权利要求1所述的行驶装置,其特征在于,
还具有输入所述姿势指令角度的操作单元。
3.如权利要求1所述的行驶装置,其特征在于,
所述控制单元,通过将所述姿势指令补正值与所述姿势指令角度相加,进行控制使得所述马达转矩和所述车轮的滚动转矩相平衡。
4.一种行驶装置的控制方法,是一边控制车轮的驱动一边进行行驶的行驶装置的控制方法,其特征在于,
根据供给的旋转指令,计算马达转矩,生成马达转矩指令信号;
检测通过所述生成的马达转矩指令信号驱动的车轮驱动系统的旋转角度变化值;
根据姿势指令角度和用所述旋转角度变化值计算出的姿势指令补正值,进行所述马达转矩的计算;
在选择了用于在斜坡路面静止的静止模式时,进行将所述姿势指令补正值与所述姿势指令角度相加的控制,在未选择所述静止模式时,将所述姿势指令补正值设定为0。
5.如权利要求4所述的行驶装置的控制方法,其特征在于,
通过将所述姿势指令补正值与所述姿势指令角度相加,进行控制使得所述马达转矩和所述车轮的滚动转矩相平衡。
CN2007800492790A 2007-12-03 2007-12-03 行驶装置及其控制方法 Expired - Fee Related CN101573250B (zh)

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
PCT/JP2007/073738 WO2009072215A1 (ja) 2007-12-03 2007-12-03 走行装置及びその制御方法

Publications (2)

Publication Number Publication Date
CN101573250A CN101573250A (zh) 2009-11-04
CN101573250B true CN101573250B (zh) 2012-06-27

Family

ID=40717401

Family Applications (1)

Application Number Title Priority Date Filing Date
CN2007800492790A Expired - Fee Related CN101573250B (zh) 2007-12-03 2007-12-03 行驶装置及其控制方法

Country Status (6)

Country Link
US (1) US20100235028A1 (zh)
EP (1) EP2093100B1 (zh)
JP (1) JP4577442B2 (zh)
CN (1) CN101573250B (zh)
DE (1) DE602007012296D1 (zh)
WO (1) WO2009072215A1 (zh)

Families Citing this family (20)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP4798181B2 (ja) * 2008-07-29 2011-10-19 トヨタ自動車株式会社 移動体、走行装置、移動体の制御方法
JP5306951B2 (ja) * 2009-09-18 2013-10-02 本田技研工業株式会社 倒立振子型車両
US9440357B2 (en) * 2011-05-02 2016-09-13 John Hu System for stabilization control of mobile robotics
JP5724855B2 (ja) * 2011-12-02 2015-05-27 トヨタ自動車株式会社 倒立移動体及び角速度センサの出力値補正方法
JP6095436B2 (ja) 2013-03-27 2017-03-15 本田技研工業株式会社 倒立振子型車両
JP6081271B2 (ja) 2013-03-29 2017-02-15 本田技研工業株式会社 倒立振子型車両
JP6081270B2 (ja) 2013-03-29 2017-02-15 本田技研工業株式会社 倒立振子型車両
JP6111119B2 (ja) 2013-03-29 2017-04-05 本田技研工業株式会社 倒立振子型車両
JP6099484B2 (ja) * 2013-05-31 2017-03-22 本田技研工業株式会社 倒立振子型車両
JP6099485B2 (ja) 2013-05-31 2017-03-22 本田技研工業株式会社 倒立振子型車両
USD768634S1 (en) 2014-08-11 2016-10-11 Apple Inc. Backplate for electronic device
WO2017147347A1 (en) 2016-02-23 2017-08-31 Deka Products Limited Partnership Mobility device control system
US11399995B2 (en) 2016-02-23 2022-08-02 Deka Products Limited Partnership Mobility device
US10926756B2 (en) 2016-02-23 2021-02-23 Deka Products Limited Partnership Mobility device
US10908045B2 (en) 2016-02-23 2021-02-02 Deka Products Limited Partnership Mobility device
CA3024145A1 (en) 2016-04-14 2017-10-19 Deka Products Limited Partnership User control device for a transporter
US10710237B2 (en) * 2017-03-22 2020-07-14 Jtekt Corporation Assist device
USD846452S1 (en) 2017-05-20 2019-04-23 Deka Products Limited Partnership Display housing
USD829612S1 (en) 2017-05-20 2018-10-02 Deka Products Limited Partnership Set of toggles
CA3106189A1 (en) 2018-06-07 2019-12-12 Deka Products Limited Partnership System and method for distributed utility service execution

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US5467275A (en) * 1992-03-19 1995-11-14 Hitachi, Ltd. Control apparatus for electric vehicle
US5568024A (en) * 1994-05-20 1996-10-22 Fuji Jukogyo Kabushiki Kaisha Drive control system and method for battery car
EP1529556A2 (en) * 2003-11-04 2005-05-11 Sony Corporation Travelling apparatus and method for controlling thereof
CN101040233A (zh) * 2005-06-29 2007-09-19 丰田自动车株式会社 移动台车的控制方法及移动台车

Family Cites Families (11)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2948402B2 (ja) * 1992-02-21 1999-09-13 三菱重工業株式会社 低濃度二酸化硫黄の回収方法
US5701965A (en) * 1993-02-24 1997-12-30 Deka Products Limited Partnership Human transporter
US5971091A (en) * 1993-02-24 1999-10-26 Deka Products Limited Partnership Transportation vehicles and methods
US6827163B2 (en) * 1994-05-27 2004-12-07 Deka Products Limited Partnership Non-linear control of a balancing vehicle
US6561294B1 (en) * 1995-02-03 2003-05-13 Deka Products Limited Partnership Balancing vehicle with passive pivotable support
JPH09135504A (ja) * 1995-11-08 1997-05-20 Nissan Motor Co Ltd 電気自動車のヒルホールド装置
US6302230B1 (en) * 1999-06-04 2001-10-16 Deka Products Limited Partnership Personal mobility vehicles and methods
EP1632428A4 (en) * 2003-06-12 2010-08-25 Toyota Motor Co Ltd COAXIAL MOTORCYCLE
JP2005094858A (ja) * 2003-09-12 2005-04-07 Sony Corp 走行装置及びその制御方法
JP4650327B2 (ja) 2005-04-14 2011-03-16 トヨタ自動車株式会社 同軸二輪車
JP4556831B2 (ja) 2005-10-13 2010-10-06 トヨタ自動車株式会社 走行装置及びその制御方法

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US5467275A (en) * 1992-03-19 1995-11-14 Hitachi, Ltd. Control apparatus for electric vehicle
US5568024A (en) * 1994-05-20 1996-10-22 Fuji Jukogyo Kabushiki Kaisha Drive control system and method for battery car
EP1529556A2 (en) * 2003-11-04 2005-05-11 Sony Corporation Travelling apparatus and method for controlling thereof
CN101040233A (zh) * 2005-06-29 2007-09-19 丰田自动车株式会社 移动台车的控制方法及移动台车

Also Published As

Publication number Publication date
JP4577442B2 (ja) 2010-11-10
WO2009072215A1 (ja) 2009-06-11
EP2093100A4 (en) 2009-12-16
US20100235028A1 (en) 2010-09-16
JPWO2009072215A1 (ja) 2011-04-21
EP2093100A1 (en) 2009-08-26
CN101573250A (zh) 2009-11-04
DE602007012296D1 (de) 2011-03-10
EP2093100B1 (en) 2011-01-26

Similar Documents

Publication Publication Date Title
CN101573250B (zh) 行驶装置及其控制方法
CN101568465B (zh) 倒立双轮式搬运车及其控制方法
CN101784437B (zh) 车辆
CN101959749B (zh) 同轴二轮车及其控制方法
EP1529556B1 (en) Travelling apparatus and method for controlling thereof
CA2659308C (en) Speed limiting in electric vehicles
JP4240114B2 (ja) 走行装置
JP4734666B2 (ja) 3輪型乗用移動台車
JP2005094858A (ja) 走行装置及びその制御方法
CN101269683A (zh) 基于姿态控制的平衡式独轮小车
CN101821155A (zh) 车辆
JP2017534500A (ja) 二輪式電気自動車
JP2007336785A (ja) 走行装置及びその制御方法
JP4556418B2 (ja) 走行装置及びその制御方法
JP2010030438A (ja) 同軸二輪車及び同軸二輪車の制御方法
CN102815357A (zh) 一种基于惯性平衡轮的自平衡载人独轮车
KR101269628B1 (ko) 볼 세그웨이
CN106184542A (zh) 一种无轮距车辆控制系统和控制方法
JP7366281B2 (ja) 二輪車
JP4442319B2 (ja) 走行装置
JP2004338507A (ja) 自動二輪車
JP5182401B2 (ja) 走行装置及びその制御方法
CN201907604U (zh) 自平衡载人独轮车系统
RU2778064C1 (ru) Транспортное средство и способ управления транспортным средством
CN218858617U (zh) 一种高速全向自平衡车

Legal Events

Date Code Title Description
C06 Publication
PB01 Publication
C10 Entry into substantive examination
SE01 Entry into force of request for substantive examination
C14 Grant of patent or utility model
GR01 Patent grant
CF01 Termination of patent right due to non-payment of annual fee

Granted publication date: 20120627

Termination date: 20151203

EXPY Termination of patent right or utility model