JP2017005814A - 移動体 - Google Patents
移動体 Download PDFInfo
- Publication number
- JP2017005814A JP2017005814A JP2015115288A JP2015115288A JP2017005814A JP 2017005814 A JP2017005814 A JP 2017005814A JP 2015115288 A JP2015115288 A JP 2015115288A JP 2015115288 A JP2015115288 A JP 2015115288A JP 2017005814 A JP2017005814 A JP 2017005814A
- Authority
- JP
- Japan
- Prior art keywords
- wheels
- wheel
- control unit
- unit
- travel control
- 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.)
- Pending
Links
Images
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
Landscapes
- Electric Propulsion And Braking For Vehicles (AREA)
Abstract
【課題】簡素な構成で移動速度入力及び角速度入力に対応した直進及び旋回を行える移動体を提供する。【解決手段】右車輪群13R及び左車輪群13Lと、車輪13毎に設けられた駆動部15と、移動速度入力及び角速度入力に対応するように各駆動部15を制御して各車輪13の回転速度を調整する共通走行制御部17Aと、車輪13毎に設けられて各車輪13の回転速度を検出する検出部19と、を備える。各車輪群13R、13Lは全方向車輪13aを有し、各車輪13の前後転で直進及び旋回可能な移動体において、各車輪13の検出回転速度から車輪群13R、13L毎に複数の車輪13に共通する推定回転速度を推定する速度推定部47を備えることで、推定回転速度に基づいて共通走行制御部17Aにより各駆動部15が制御される。【選択図】図2
Description
本発明は、全方向車輪を含む複数の車輪の回転を駆動制御して直進及び旋回する移動体に関する。
従来、全方向車輪を含む複数の車輪の回転を駆動制御して直進及び旋回する移動体として、例えば特許文献1などに記載の技術が知られている。
特許文献1には、一対の全方向車輪からなる前輪,一対のゴムタイヤからなる中間輪及び一対の全方向車輪からなる後輪が設けられた搬送車が提案されている。制御部において、経路指令部からの指令に基づく移動速度及び角速度が入力されると、これらに対応するように各車輪の駆動部毎に電流が制御され、各車輪の回転速度、向き、タイミング等が調整されて搬送車が直進及び旋回する。走行時には各車輪の回転速度が検出されており、各車輪の回転速度を経路指令部からの指令に対応する回転速度となるように各車輪が制御される。
しかしながら、特許文献1などの従来の搬送車では、路面状況や車輪の摩耗などの影響で、各車輪に空転やロック等のスリップが生じると、ハンドル角や走行速度にズレが生じて走行安定性が低下したり、オドメトリの精度が低下して走行軌跡の忠実度が悪化したりする。さらに車輪毎に回転速度を検出して制御されていたため、車輪毎の条件の違いにより、一部の車輪ではトルクを増加させて他の車輪ではトルクを減少させるようなことが起こり易く、各車輪と路面との間で作用する力が互いに逆方向となって効率を悪化させる。
そこで、本発明は、簡素な構成で指令入力に精度よく対応した直進及び旋回を行うことができる移動体を提供することを目的とする。
本発明のコンセプトは次の通りである。
[1] 全方向車輪を含む複数の車輪からなる左右の各車輪群と、前記複数の車輪のそれぞれに設けられた複数の駆動部と、指令入力に対応するように前記複数の駆動部を制御して前記複数の車輪の回転速度を調整する走行制御部と、前記複数の車輪それぞれの回転速度を検出する複数の検出部と、を備え、前記複数の車輪の回転により直進及び旋回可能な移動体において、
前記複数の検出部で検出された前記複数の車輪の検出回転速度から、前記各車輪群の前記複数の車輪に共通する推定回転速度を推定する速度推定部を備え、前記推定回転速度に基づいて前記走行制御部により前記複数の駆動部が制御される、移動体。
[1] 全方向車輪を含む複数の車輪からなる左右の各車輪群と、前記複数の車輪のそれぞれに設けられた複数の駆動部と、指令入力に対応するように前記複数の駆動部を制御して前記複数の車輪の回転速度を調整する走行制御部と、前記複数の車輪それぞれの回転速度を検出する複数の検出部と、を備え、前記複数の車輪の回転により直進及び旋回可能な移動体において、
前記複数の検出部で検出された前記複数の車輪の検出回転速度から、前記各車輪群の前記複数の車輪に共通する推定回転速度を推定する速度推定部を備え、前記推定回転速度に基づいて前記走行制御部により前記複数の駆動部が制御される、移動体。
[2] 前記走行制御部は、前記指令入力に対応するように前記複数の駆動部を制御する共通走行制御部と、前記駆動部毎に設けられて該各駆動部に対する前記共通走行制御部の制御の停止期間に該各駆動部を制御する個別走行制御部と、を備える、前記[1]に記載の移動体。
[3] 全方向車輪を含む複数の車輪と、前記車輪毎に設けられた複数の駆動部と、指令入力に対応するように前記複数の駆動部を制御して前記複数の車輪の回転速度を調整する走行制御部と、前記各車輪に設けられて各車輪の回転速度を検出する複数の検出部と、を備え、前記複数の車輪の回転により直進及び旋回可能な移動体において、
前記走行制御部は、前記指令入力に対応するように前記複数の駆動部を制御する共通走行制御部と、前記駆動部毎に設けられて該各駆動部に対する前記共通走行制御部の制御の停止期間に該各駆動部を制御する複数の個別走行制御部と、を備える、移動体。
前記走行制御部は、前記指令入力に対応するように前記複数の駆動部を制御する共通走行制御部と、前記駆動部毎に設けられて該各駆動部に対する前記共通走行制御部の制御の停止期間に該各駆動部を制御する複数の個別走行制御部と、を備える、移動体。
[4] 前記個別走行制御部は、前記制御の停止期間に前記推定回転速度に基づいて前記各駆動部を制御する、前記[2]又は[3]に記載の移動体。
[5] 前記個別走行制御部は、前記制御の停止期間に予め設定された前記車輪の停止処理を行う、前記[2]又は[3]に記載の移動体。
[5] 前記個別走行制御部は、前記制御の停止期間に予め設定された前記車輪の停止処理を行う、前記[2]又は[3]に記載の移動体。
[6] 前記検出回転速度に基づいて前記各車輪のスリップを検出するスリップ検出部を備え、前記走行制御部はスリップが検出された前記車輪の駆動部に対し回復処理を行う、前記[1]乃至[5]の何れかに記載の移動体。
[7] 前記走行制御部は、前記駆動部へ供給する電流を分配するトルク分配部を備え、前記トルク分配部は、加速時及び減速時のうちの少なくとも一方において、前記複数の車輪における前側と後側とのトルク比を変化させる、前記[1]乃至[6]の何れかに記載の移動体。
本発明の移動体によれば、各車輪群における複数の車輪の検出回転速度から、その車輪群の車輪に共通する推定回転速度を推定し、推定回転速度に基づいて複数の駆動部を制御して各車輪の回転速度を調整するので、各車輪毎に回転速度を検出してそれぞれを独立に制御する場合のように、各車輪の条件の違いなどに起因して各車輪のトルクバランスが崩れて効率が悪化するようなことを確実に防止できる。
また、複数の車輪のうちの一部の車輪について、スリップや回転抵抗などにより不適切な回転速度が検出部で検出されたとき、その不適切な回転速度に基づいて、複数の車輪の駆動部が制御されることを防止できるとともに、不適切な回転速度に基づいて移動体の走行状態や軌跡が把握されることを防止できる。さらに、指令入力に対応する直進速度及び旋回速度を実現するための複数の車輪の制御が容易になる。従って、簡素な構成で指令入力に精度よく対応した直進及び旋回を行うことができる移動体を提供することができる。
また本発明の移動体では、共通走行制御部の制御停止期間に各車輪の駆動部を個別に制御する個別走行制御部が設けられているので、何れかの駆動部に対する共通走行制御部の制御が共通制御部の処理により停止されたり通信等の装置の異常により停止されたりしたとき、個別走行制御部によりその駆動部を制御できる。
例えば、共通制御部の制御が停止した駆動部に対し、個別走行制御部により推定回転速度に基づいて制御することで、走行を継続できる。また装置の異常等により共通制御部の制御が停止した駆動部に対し、個別走行制御部により予め設定された車輪の停止処理行うことで、滑らかに停止させることができる。さらに停止処理の設定により、一時的に制御が停止されて回復した場合にも滑らかに走行させることができ、容易に制御を復帰できる。
従って、本発明の移動体によれば、簡素な構成で指令入力に精度よく対応した直進及び旋回を行うことができる。
従って、本発明の移動体によれば、簡素な構成で指令入力に精度よく対応した直進及び旋回を行うことができる。
以下、本発明の実施形態について図を用いて詳細に説明する。
図1に示すように、この実施形態の移動体10は、車体11と、車体11に配設された複数の車輪13と、車輪13毎に設けられた複数の駆動部15とを備えて構成されている。そしてこの移動体10は、図2に示すように、走行経路などの走行指令が入力される指令入力部21と、複数の駆動部15を制御する走行制御部17と、車輪13毎に設けられた複数の検出部19と、走行軌跡等を記録するオドメトリ部23と、各部間を接続するCAN通信系25と、を備えている。
図1に示すように、この実施形態の移動体10は、車体11と、車体11に配設された複数の車輪13と、車輪13毎に設けられた複数の駆動部15とを備えて構成されている。そしてこの移動体10は、図2に示すように、走行経路などの走行指令が入力される指令入力部21と、複数の駆動部15を制御する走行制御部17と、車輪13毎に設けられた複数の検出部19と、走行軌跡等を記録するオドメトリ部23と、各部間を接続するCAN通信系25と、を備えている。
複数の車輪13は、前後方向に延びる中心線Lの両側に左右対称に配設された2対の全方向車輪13aからなる前輪及び後輪と、1対のゴムタイヤ13bからなる中間輪と、を備え、中心線Lを挟んで左右にこれらの車輪13からなる右車輪群13Rと左車輪群13Lとが構成されている。この実施形態では、制御系の簡素化のため、全ての車輪13が中心線Lに直交する方向の車軸に、全て同じトレッドで配設されている。
ゴムタイヤ13bは、路面と十分な摩擦力で接地して前後に回転可能に配設されている。全方向車輪13aは、回転方向とは異なる方向、ここでは車輪13の回転方向に対して交差する方向に転動自在な複数の転動体27が外周に配列されている。
ゴムタイヤ13b及び全方向車輪13aには、車輪13毎に駆動部15及び検出部19が設けられている。各駆動部15には、駆動モータ29と、駆動モータ29に電力を調整して供給する電流調整部31と、が設けられている。電流調整部31は、走行制御部17からの制御信号に従って駆動モータ29への電流量を調整し、各車輪13の正逆転の回転方向と回転速度を調整可能となっている。車輪13毎に検出部19が設けられており、各車輪13の回転速度が検出可能となっている。
指令入力部21は、移動体10が走行するための情報、例えば車体11の移動速度と旋回速度等の角速度とを含む指令が入力される部位であり、ジョイスティック等のように走行中に操作することで走行指令が入力されるものであってもよく、予め記憶部等に記憶された走行経路等に基づいて走行指令が入力されるものであってもよい。この実施形態では、指令入力部21が予め設定された走行経路に基づいて走行指令を走行制御部17に入力するものとなっており、走行軌跡を記録するオドメトリ部23と一体となっている。
走行制御部17は、指令入力に対応するように複数の駆動部15を統一的に制御する共通走行制御部17Aと、各車輪13のドライバに設けられていて、駆動部15に対する共通走行制御部17Aからの制御の停止期間に、各駆動部15を制御する個別走行制御部としての補助速度制御部17Bとを備えている。
共通走行制御部17Aは、右車輪群13Rを制御するための右車輪群用制御部17Rと、左車輪群13Lを制御するための左車輪群用制御部17Lと、指令入力部21からの指令入力を目標ハンドル角や右車輪群13R及び左車輪群13Lの目標回転速度などの、各車輪群用制御部17R,17Lにより処理可能な情報に変換して各車輪群用制御部17R,17Lに供給する変換部33と、を備えている。
右車輪群用制御部17R及び左車輪群用制御部17Lのそれぞれには、制御信号生成部35と走行状態検出部37とが設けられている。制御信号生成部35は、各車輪13の駆動部15への制御信号を生成して出力する主速度制御部41と、走行状態に応じて各車輪13のトルク配分を調整するトルク分配部43と、スリップを回復するためのスリップ回復部45と、を備えている。また、走行状態検出部37は、各車輪群13R,13L毎に単一の推定回転速度を推定する速度推定部47と、各車輪13の空転やロック等のスリップを検出するスリップ検出部49と、を備えている。
主速度制御部41では、複数の車輪13の各駆動部15に車輪群13R,13L毎に同一のトルク又は所定の相関を有するトルクを出力させるための電流制御信号を生成して送信する。ここで、「所定の相関を有するトルク」とは、同じ車輪群13R,13Lを構成する前輪、中間輪及び後輪からなる複数の車輪13に供給するトルクを、主速度制御部41の単一の処理結果に基づいて、後述するトルク分配部43において走行状態に応じた配分で調整したものである。
主速度制御部41では、例えば所定速度で直進する場合、右車輪群13Rを構成する全ての車輪13の各駆動部15と左車輪群13Lを構成する全ての車輪13の各駆動部15とに、同じ回転方向で同じトルクを出力するための単一の電流制御信号を送信する。所定速度で旋回する場合、右車輪群13Rを構成する全ての車輪13の各駆動部15に共通に同じ回転方向で同じトルクを出力するように、単一の右車輪用の電流制御信号を送信し、同時に、左車輪群13Lを構成する全ての車輪13の各駆動部15に共通に同じ回転方向で、右車輪用とは別のトルクを出力するための単一の左車輪用の電流制御信号を送信する。
トルク分配部43では、主速度制御部41において生成される単一の処理結果に基づき、加速時、減速時等の走行状態における加速度に応じてトルクの配分を調整する。ここでは、加速時及び減速時のうちの少なくとも一方において、複数の車輪13における前側と後側とのトルク比を変化させるのがよい。例えば、走行状態により荷重が増加する側でトルクを増加したり、荷重が減少する側でトルクを減少したりする。具体的には、加速時に後輪の駆動部15のトルクを増加し、減速時に前輪の駆動部15のトルクを増加する。
速度推定部47では、各車輪13の検出部19で検出された検出回転速度に基づいて、車輪群13R,13L毎に複数の車輪13に共通する回転速度を推定して推定回転速度として主速度制御部41に伝達するとともに、個別走行制御部としての補助速度制御部17Bに伝達する。ここで「回転速度を推定する」とは、予め設定された手順に従って単一の回転速度を求めることである。各車輪群13R,13Lは複数の車輪13を有し、車輪13毎に別の駆動部15により駆動されているため、各駆動部15から同一又は所定の相関のトルクを出力しても、各車輪13の摩耗や転がり抵抗の差、或いは雪道や凹凸等の路面状況の差などにより、一部の車輪13の回転が不足することや、過回転して車体11の移動に対応した適正な回転速度が検出されないことがある。そのため、速度推定部47では、検出部19から伝達された同じ車輪群13R,13Lにおける全ての車輪13の検出回転速度に基づいて、車輪群毎に適正な単一の推定回転速度を求める。
推定方法は任意であり、例えば、予め設定した基準に基づいて各車輪13の検出回転速度を判定処理し、基準を満たす車輪13の検出回転速度を推定回転速度として用いることができる。具体的には、各車輪群13R,13L毎に、一部の車輪13の回転速度に予め設定された異常状態が検出されたとき、異常状態が検出された車輪13の検出回転速度を除外して、残りが同じであればその検出回転速度を推定回転速度として採用することも可能である。また、加速時、順行時、減速時に場合分けし、それぞれで選択基準を設けてもよい。例えば、加速時には最も検出回転速度が低いもの、減速時には最も検出速度が高いものを推定回転速度として採用することもできる。
スリップ検出部49では、各検出部19で検出された車輪13の検出回転速度に基づいて、一部の車輪13のロックや空転等のスリップを検出し、スリップ検出信号を送信する。
この実施形態では、スリップ検出信号が速度推定部47に伝達されると、スリップを生じた車輪13の検出回転速度を推定処理から除外するように構成されている。
この実施形態では、スリップ検出信号が速度推定部47に伝達されると、スリップを生じた車輪13の検出回転速度を推定処理から除外するように構成されている。
一方、スリップ回復部45では、スリップが検出された車輪13に対し、主速度制御部41の制御を停止したり、推定回転速度に基づいてスリップを回復するのに適した制御信号を送信することで、回復処理を行う。
個別走行制御部としての補助速度制御部17Bは、各車輪13の駆動部15毎にドライバに設けられていて、各車輪13の駆動部15に対する共通走行制御部17Aからの制御の停止期間に駆動部15を制御するものである。補助速度制御部17Bには、共通走行制御部17Aにおける制御の停止期間に行う制御手順が設定されている。例えば、共通走行制御部17Aにおける制御の停止期間に、速度推定部47から推定回転速度が伝達されるとともに、検出部19から検出回転速度が伝達されている場合には、推定回転速度に基づいて駆動部を制御し、検出回転速度を推定回転速度に合わせるための処理を行ってもよい。また、CAN通信系25の切断等により、共通走行制御部17Aから全く信号が伝達されない場合には、制御の停止期間に予め補助速度制御部17Bに設定されている車輪13の停止処理を行うようにしてもよい。その場合、共通走行制御部17Aからの信号が伝達可能な他の車輪13の駆動部15には、共通走行制御部17Aから同様の車輪13の停止処理を行うのがよい。
次に、このような移動体10の動作について説明する。
経路指令PC等の指令入力部21から移動速度と角速度を含む走行指令が主速度制御部41に入力されると、変換部33において、ハンドル角、右車輪群13Rの回転速度、左車輪群13Lの回転速度に変換され、右車輪群用制御部17Rと左車輪群用制御部17Lとにそれぞれ伝達される。
右車輪群用制御部17Rの各主速度制御部41及びトルク分配部43で同一又は所定相関を有する電流制御信号を生成し、右車輪群13Rを構成する複数の車輪13の各駆動部15へCAN通信系25により送信する。また、左車輪群用制御部17Lの各主速度制御部41及びトルク分配部43で同一又は所定相関を有する電流制御信号を生成して、左車輪群13Lを構成する複数の車輪13の各駆動部15へCAN通信系25により送信する。
経路指令PC等の指令入力部21から移動速度と角速度を含む走行指令が主速度制御部41に入力されると、変換部33において、ハンドル角、右車輪群13Rの回転速度、左車輪群13Lの回転速度に変換され、右車輪群用制御部17Rと左車輪群用制御部17Lとにそれぞれ伝達される。
右車輪群用制御部17Rの各主速度制御部41及びトルク分配部43で同一又は所定相関を有する電流制御信号を生成し、右車輪群13Rを構成する複数の車輪13の各駆動部15へCAN通信系25により送信する。また、左車輪群用制御部17Lの各主速度制御部41及びトルク分配部43で同一又は所定相関を有する電流制御信号を生成して、左車輪群13Lを構成する複数の車輪13の各駆動部15へCAN通信系25により送信する。
各駆動部15では、電流制御信号を受信することで、個別走行制御部としての補助速度制御部17Bで処理されずに、電流制御信号が電流調整部31へ伝達される。そして、右車輪群13Rの各駆動モータ29に同一又は所定相関を有する電流制御信号が供給されて、右車輪群13Rの複数の車輪13が同一又は所定相関を有するトルクで回転駆動される。また、左車輪群13Lでも同様に、左車輪群13Lの複数の車輪13が同一又は所定相関を有するトルクで回転駆動される。
これにより、右車輪群13Rにおける複数の車輪13が制御された回転速度で前転又は後転するとともに、左車輪群13Lにおける複数の車輪13が、制御された回転速度で前転又は後転することで、指令入力に対応するように移動体10が直進又は旋回する。
これにより、右車輪群13Rにおける複数の車輪13が制御された回転速度で前転又は後転するとともに、左車輪群13Lにおける複数の車輪13が、制御された回転速度で前転又は後転することで、指令入力に対応するように移動体10が直進又は旋回する。
移動体10が走行する際、車輪13毎に設けられた検出部19により、全ての車輪13の回転速度がそれぞれ検出されて、検出回転速度がそれぞれ共通走行制御部17Aの各車輪群用制御部17R,17Lに設けられた走行状態検出部37に送信されている。
走行状態検出部37では、各車輪13の検出回転速度が速度推定部47に伝達され、車輪群13R,13L毎に複数の車輪13に共通する推定回転速度が求められ、車輪群13R,13L毎に単一の推定回転速度として推定される。この各車輪群13R,13L毎の推定回転速度はそれぞれ制御信号生成部35に送信される。
また走行状態検出部37では、各車輪13の検出回転速度がスリップ検出部49に伝達され、各車輪群13R,13Lの単一の推定回転速度と各車輪群13R,13Lにおける複数の車輪13の検出回転速度とに基づいてスリップが検出される。
走行状態検出部37では、各車輪13の検出回転速度が速度推定部47に伝達され、車輪群13R,13L毎に複数の車輪13に共通する推定回転速度が求められ、車輪群13R,13L毎に単一の推定回転速度として推定される。この各車輪群13R,13L毎の推定回転速度はそれぞれ制御信号生成部35に送信される。
また走行状態検出部37では、各車輪13の検出回転速度がスリップ検出部49に伝達され、各車輪群13R,13Lの単一の推定回転速度と各車輪群13R,13Lにおける複数の車輪13の検出回転速度とに基づいてスリップが検出される。
制御信号生成部35では、各車輪群13R,13L毎の推定回転速度が主速度制御部41に伝達される。主速度制御部41では、上述のように、指令入力部21からの走行指令が変換部33で各車輪群13R,13L毎に変換された指令回転速度が伝達されているため、推定回転速度を指令回転速度に変化させるために必要な制御量が求められ、出力される。
またこの制御信号生成部35では、主速度制御部41で得られた制御量がトルク分配部43に伝達される。ここでは、前輪、中間輪、後輪における車輪13の駆動部15のトルクが走行状態に応じたトルク配分となるように、各駆動部15に送信する制御量を所定の相関で調整する。ここでは加速時及び減速時のうちの少なくとも一方で、複数の車輪13における前側と後側とのトルク比を変化させる。
これにより制御信号が生成され、CAN通信系25を介して各車輪13の駆動部15に伝達される。そしてこの制御信号により、上述のように各車輪13の回転が制御されることで、車輪群13R,13L毎の推定回転速度に基づいて走行制御部17により複数の駆動部15が制御されることになる。
またこの制御信号生成部35では、主速度制御部41で得られた制御量がトルク分配部43に伝達される。ここでは、前輪、中間輪、後輪における車輪13の駆動部15のトルクが走行状態に応じたトルク配分となるように、各駆動部15に送信する制御量を所定の相関で調整する。ここでは加速時及び減速時のうちの少なくとも一方で、複数の車輪13における前側と後側とのトルク比を変化させる。
これにより制御信号が生成され、CAN通信系25を介して各車輪13の駆動部15に伝達される。そしてこの制御信号により、上述のように各車輪13の回転が制御されることで、車輪群13R,13L毎の推定回転速度に基づいて走行制御部17により複数の駆動部15が制御されることになる。
なお、スリップ検出部49でスリップが検出された場合は、制御信号生成部35のスリップ回復部45において、推定回転速度に基づいてスリップを回復するのに適した制御信号を生成して送信する。ここで、スリップが検出された車輪13の駆動部15に対し、車輪13の回転速度を推定回転速度にする補正制御を行ってもよい。また、スリップが検出された車輪13の駆動部15に対する共通走行制御部17Aの制御を停止し、補助速度制御部17Bによりスリップの回復処理を行うことも可能である。
このような制御により、移動体10の移動中には、速度推定部47において推定された右車輪群13Rの単一の推定回転速度と左車輪群13Lの単一の推定回転速度がオドメトリ部23に伝達されていて、各推定回転速度から移動体10の速度及び角速度を求めて走行経路を積算している。
以上のように、この移動体によれば、各車輪群13R,13Lにおける複数の車輪13の検出回転速度から、その車輪群13R,13Lの車輪13に共通する推定回転速度を推定し、推定回転速度に基づいて複数の駆動部15を制御して各車輪13の回転速度を調整する。したがって、各車輪13毎に回転速度を検出してそれぞれを独立に制御する場合のように、各車輪13の条件の違いなどに起因して各車輪13のトルクバランスが崩れて効率が悪化することを確実に防止できる。
また、複数の車輪13のうちの一部の車輪13について、スリップや回転抵抗などにより不適切な回転速度が検出部で検出されたときは、その不適切な回転速度に基づいて、複数の車輪13の駆動部15が制御されることを防止できる。加えて、不適切な回転速度に基づいて移動体10の走行状態や軌跡が把握されることを防止できる。
さらに、指令入力に対応する直進速度及び旋回速度を実現するための複数の車輪13の制御が容易である。
従って、簡素な構成で指令入力に精度よく対応した直進及び旋回を行うことができる。
さらに、指令入力に対応する直進速度及び旋回速度を実現するための複数の車輪13の制御が容易である。
従って、簡素な構成で指令入力に精度よく対応した直進及び旋回を行うことができる。
また、この移動体10によれば、共通走行制御部17Aの制御停止期間に各車輪13の駆動部15を個別に制御する個別走行制御部としての補助速度制御部17Bが設けられているので、何れかの駆動部15に対する共通走行制御部17Aの制御が共通走行制御部17Aの処理により停止されたり、CAN通信系25等の異常により停止されたりしたときは、補助速度制御部17Bによりその駆動部15を制御できる。
例えば、共通走行制御部17Aの制御が停止した駆動部15に対し、補助速度制御部17Bにより推定回転速度に基づいて制御することで、走行を継続できる。また、装置の異常等により共通走行制御部17Aの制御が停止した駆動部15に対しは、補助速度制御部17Bにより予め設定された車輪13の停止処理を行うことで、滑らかに停止させることができる。さらに、停止処理の設定により、一時的に制御が停止されて回復した場合にも滑らかに走行させることができ、容易に制御を復帰できる。
従って、簡素な構成で指令入力に精度よく対応した直進及び旋回を行うことができる。
従って、簡素な構成で指令入力に精度よく対応した直進及び旋回を行うことができる。
なお、上記実施の形態は本発明の範囲内において適宜変更可能である。
例えば上記実施形態では、右車輪群13R及び左車輪群13Lの前輪及び後輪が全方向車輪13aからなり、中間輪がゴムタイヤ13bからなる例について説明したが、車輪の数や配置は何ら限定されず、車輪の数や配置に応じた制御を実施することで、容易に本発明を適用することが可能である。
例えば上記実施形態では、右車輪群13R及び左車輪群13Lの前輪及び後輪が全方向車輪13aからなり、中間輪がゴムタイヤ13bからなる例について説明したが、車輪の数や配置は何ら限定されず、車輪の数や配置に応じた制御を実施することで、容易に本発明を適用することが可能である。
10:移動体
11:車体
13:車輪
13a:全方向車輪
13b:ゴムタイヤ
13R:右車輪群
13L:左車輪群
15:駆動部
17:走行制御部
17A:共通走行制御部
17B:補助速度制御部(個別走行制御部)
17R:右車輪群用制御部
17L:左車輪群用制御部
19:検出部
21:指令入力部
23:オドメトリ部
25:CAN通信系
27:転動体
29:駆動モータ
31:電流調整部
33:変換部
35:制御信号生成部
37:走行状態検出部
41:主速度制御部
43:トルク分配部
45:スリップ回復部
47:速度推定部
49:スリップ検出部
11:車体
13:車輪
13a:全方向車輪
13b:ゴムタイヤ
13R:右車輪群
13L:左車輪群
15:駆動部
17:走行制御部
17A:共通走行制御部
17B:補助速度制御部(個別走行制御部)
17R:右車輪群用制御部
17L:左車輪群用制御部
19:検出部
21:指令入力部
23:オドメトリ部
25:CAN通信系
27:転動体
29:駆動モータ
31:電流調整部
33:変換部
35:制御信号生成部
37:走行状態検出部
41:主速度制御部
43:トルク分配部
45:スリップ回復部
47:速度推定部
49:スリップ検出部
Claims (7)
- 全方向車輪を含む複数の車輪からなる左右の各車輪群と、前記複数の車輪のそれぞれに設けられた複数の駆動部と、指令入力に対応するように前記複数の駆動部を制御して前記複数の車輪の回転速度を調整する走行制御部と、前記複数の車輪それぞれの回転速度を検出する複数の検出部と、を備え、前記複数の車輪の回転により直進及び旋回可能な移動体において、
前記複数の検出部で検出された前記複数の車輪の検出回転速度から、前記各車輪群の前記複数の車輪に共通する推定回転速度を推定する速度推定部を備え、前記推定回転速度に基づいて前記走行制御部により前記複数の駆動部が制御される、移動体。 - 前記走行制御部は、前記指令入力に対応するように前記複数の駆動部を制御する共通走行制御部と、前記駆動部毎に設けられて該駆動部に対する前記共通走行制御部の制御の停止期間に該駆動部を制御する複数の個別走行制御部と、を備える、請求項1に記載の移動体。
- 全方向車輪を含む複数の車輪と、前記車輪毎に設けられた複数の駆動部と、指令入力に対応するように前記複数の駆動部を制御して前記複数の車輪の回転速度を調整する走行制御部と、前記各車輪に設けられて各車輪の回転速度を検出する複数の検出部と、を備え、前記複数の車輪の回転により直進及び旋回可能な移動体において、
前記走行制御部は、前記指令入力に対応するように前記複数の駆動部を制御する共通走行制御部と、前記駆動部毎に設けられて該駆動部に対する前記共通走行制御部の制御の停止期間に該駆動部を制御する複数の個別走行制御部と、を備える、移動体。 - 前記個別走行制御部は、前記制御の停止期間に前記推定回転速度に基づいて前記各駆動部を制御する、請求項2又は3に記載の移動体。
- 前記個別走行制御部は、前記制御の停止期間に予め設定された前記車輪の停止処理を行う、請求項2又は3に記載の移動体。
- 前記検出回転速度に基づいて前記各車輪のスリップを検出するスリップ検出部を備え、前記走行制御部はスリップが検出された前記車輪の駆動部に対し回復処理を行う、請求項1乃至5の何れかに記載の移動体。
- 前記走行制御部は、前記駆動部へ供給する電流を分配するトルク分配部を備え、前記トルク分配部は、加速時及び減速時のうちの少なくとも一方において、前記複数の車輪における前側と後側とのトルク比を変化させる、請求項1乃至6の何れかに記載の移動体。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2015115288A JP2017005814A (ja) | 2015-06-05 | 2015-06-05 | 移動体 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2015115288A JP2017005814A (ja) | 2015-06-05 | 2015-06-05 | 移動体 |
Publications (1)
Publication Number | Publication Date |
---|---|
JP2017005814A true JP2017005814A (ja) | 2017-01-05 |
Family
ID=57751985
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2015115288A Pending JP2017005814A (ja) | 2015-06-05 | 2015-06-05 | 移動体 |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP2017005814A (ja) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2019052863A1 (de) * | 2017-09-18 | 2019-03-21 | Kuka Deutschland Gmbh | Ermittlung von bewegungen omnidirektionaler plattformen |
-
2015
- 2015-06-05 JP JP2015115288A patent/JP2017005814A/ja active Pending
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2019052863A1 (de) * | 2017-09-18 | 2019-03-21 | Kuka Deutschland Gmbh | Ermittlung von bewegungen omnidirektionaler plattformen |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN102107660B (zh) | 使用了加加速度信息的车辆的运动控制装置 | |
CN1325298C (zh) | 汽车控制方法和汽车控制装置 | |
US20140379220A1 (en) | Vehicle with independently driven multiple axes, and controller which independently drives multiple axles | |
JP2009006873A (ja) | 車両用駆動制御装置 | |
WO2015190349A1 (ja) | 左右独立駆動車のトラクション制御機能付き駆動制御装置 | |
JP6502074B2 (ja) | 車両の制駆動力制御装置 | |
CN105459848A (zh) | 车辆的控制装置及车辆的控制方法 | |
WO2015107943A1 (ja) | 四輪独立駆動車の一輪失陥時車両制御装置 | |
JP4524597B2 (ja) | 四輪独立駆動車の駆動力配分装置 | |
CN104139777A (zh) | 车辆行驶控制装置和方法 | |
JP4845839B2 (ja) | 電気駆動車両 | |
JP2008040936A (ja) | 無人搬送車の走行制御装置 | |
KR20210071133A (ko) | 차량의 자세 제어 방법 | |
US7434646B2 (en) | On-demand four wheel drive system | |
JP2008141875A (ja) | 走行装置及び駆動制御装置 | |
JP2017005814A (ja) | 移動体 | |
JP4725431B2 (ja) | 電動車両の駆動力推定装置、自動車および電動車両の駆動力推定方法 | |
JP2014024434A (ja) | 搬送車 | |
CN112026535A (zh) | 一种分布式四驱电动车的控制方法及控制*** | |
JP2006187047A (ja) | 4輪独立駆動車の駆動力制御装置 | |
CN108688466A (zh) | 用于运行机动车的方法、控制器和机动车 | |
JP2004336910A (ja) | 車両の駆動制御装置 | |
JP7348262B2 (ja) | トルクステアの出現の段階的検出 | |
KR102200093B1 (ko) | 전동식 조향 시스템의 제어 방법 | |
JP2009035221A (ja) | 車両用走行制御装置及びその方法 |