特開 2024-141245 搬送車、連結部、距離特定方法および距離特定プログラム

(19)【発行国】日本国特許庁(JP)

(12)【公報種別】公開特許公報(A)

(11)【公開番号】P2024141245

(43)【公開日】2024-10-10

(54)【発明の名称】搬送車、連結部、距離特定方法および距離特定プログラム

(51)【国際特許分類】

   B66F 9/24 20060101AFI20241003BHJP

   B66F 9/14 20060101ALI20241003BHJP

【ＦＩ】

B66F9/24 P

B66F9/14 A

【審査請求】有

【請求項の数】8

【出願形態】ＯＬ

(21)【出願番号】P 2023052776

(22)【出願日】2023-03-29

(71)【出願人】

【識別番号】000232807

【氏名又は名称】三菱ロジスネクスト株式会社

(74)【代理人】

【識別番号】110000475

【氏名又は名称】弁理士法人みのり特許事務所

(72)【発明者】

【氏名】吉田 徹郎

【テーマコード（参考）】

3F333

【Ｆターム（参考）】

3F333AA02

3F333AE01

3F333AE02

3F333BA21

3F333FA05

3F333FA21

3F333FD11

3F333FD15

3F333FE04

3F333FE05

3F333FE09

(57)【要約】

【課題】移動棚やトラックなどが所定の位置からずれていても、後から荷積載位置を調整することができる搬送車を提供する。
【解決手段】搬送車１は、フォーク１６と、水平にレーザを照射して点群ＰＧを取得する点群取得部２２と、取得された点群ＰＧに基づいて、フォーク１６に積載された荷と、荷積載位置に隣接している物との間の左右方向の距離を特定する距離特定部と、を備えている。点群取得部２２は、フォーク１６に積載された荷と、荷積載位置とにレーザを照射することができる位置に配置されている。
【選択図】図１

【特許請求の範囲】

【請求項1】

荷積載部と、
前記荷積載部に積載された前記荷と、荷積載位置とにレーザを照射することができる位置に配置され、水平にレーザを照射して点群を取得する点群取得部と、
取得された前記点群に基づいて、前記荷積載部に積載された荷と、前記荷積載位置に隣接している物との間の左右方向の距離を特定する距離特定部と、を備える、搬送車。

【請求項2】

前記搬送車は、フォークリフトであって、バックレストを備え、
前記点群取得部は、前記バックレストに設けられている、請求項１に記載の搬送車。

【請求項3】

連結部をさらに備え、
前記連結部は、前記バックレストおよび前記点群取得部に連結され、前記点群取得部を、平面視、前記バックレストの左右いずれかの端部の斜め後ろに配置させる、請求項２に記載の搬送車。

【請求項4】

前記距離特定部は、取得された前記点群に基づいて、前記荷積載部に積載された前記荷と、前記荷積載位置に隣接している前記物との間の前後方向の距離をさらに特定する、請求項１に記載の搬送車。

【請求項5】

搬送車の荷積載部に積載された荷と、荷積載位置に隣接している物との間の左右方向の距離特定方法であって、
前記荷積載部に積載された前記荷と、前記荷積載位置に隣接している前記物とに、水平にレーザを照射して点群を取得するステップと、
取得された前記点群に基づいて、前記荷積載部に積載された前記荷と、前記荷積載位置に隣接している前記物との間の左右方向の距離を特定するステップと、を含む、距離特定方法。

【請求項6】

搬送車の荷積載部に積載された荷と、荷積載位置に隣接している物との間の前後方向の距離特定方法であって、
前記荷積載部に積載された前記荷と、前記荷積載位置に隣接している前記物とに、水平にレーザを照射して点群を取得するステップと、
取得された前記点群に基づいて、前記荷積載部に積載された前記荷と、前記荷積載位置に隣接している前記物との間の前後方向の距離を特定するステップと、を含む、距離特定方法。

【請求項7】

荷積載部と、
前記荷積載部に積載された荷と、荷積載位置とに水平にレーザを照射できるよう構成され、点群を取得する点群取得部と、
コンピュータと、を備えた搬送車の前記コンピュータに、
取得された前記点群に基づいて、前記荷積載部に積載された前記荷と、前記荷積載位置に隣接している物との間の距離を特定するステップを実行させる、距離特定プログラム。

【請求項8】

荷積載部と、
前記荷積載部に積載された荷と、荷積載位置とにレーザを水平に照射できるよう構成され、点群を取得する点群取得部と、
取得された前記点群に基づいて、前記荷積載部に積載された前記荷と、前記荷積載位置に隣接している物との間の左右方向の距離を特定する距離特定部と、
バックレストと、を備えた搬送車に設けられる連結部であって、
前記連結部は、
前記バックレストの左右いずれかの端部または上端に固定された第１端部と、
平面視、前記第１端部から前記バックレストの斜め後ろに延びる中間部と、
前記中間部から連続し、前記点群取得部を支持する第２端部と、を備える連結部。

【発明の詳細な説明】

【技術分野】

【0001】

本発明は、搬送車、連結部、距離特定方法および距離特定プログラムに関する。

【背景技術】

【0002】

従来、特許文献１に示すように、自律して走行し荷役を行う無人搬送車がある。特許文献１に開示の無人搬送車は、フォークと、フォークを昇降させる昇降装置と、自機位置を検出するレーザスキャナと、を備えている。無人搬送車は、自機位置を検出しながら予め定められた荷役位置まで移動し、フォークを昇降させて荷役作業を行うよう構成されている。

【0003】

ところで、特許文献１に開示のように、無人搬送車は、移動棚に対して荷役を行うことがある。移動棚は、固定されている棚と違って移動するが、この移動の際に所定の移動位置からずれることがある。すると、所定の荷役位置と、移動棚との間にずれが生じることになるが、特許文献１の無人搬送システムは、このずれについて考慮されていない。また、所定の位置に停車したトラックに荷役作業を行う際にも、トラックが所定の待機位置からずれていることがあり、この場合にも、所定の荷役位置との間でズレが生じる。移動棚やトラックがずれることを想定して荷役位置を定めると、荷と荷との間をつめて積載することができないという問題がある。この問題を解決するためには、無人搬送車が所定の荷役位置に到着後、荷積載位置を調整することが好ましいが、移動棚やトラックなどが所定の位置からどの程度ずれているのかを認識することは容易ではなく、難しい。

【先行技術文献】

【特許文献】

【0004】

【特許文献1】特開２０２０－０３０６４２号公報

【発明の概要】

【発明が解決しようとする課題】

【0005】

そこで、本発明が解決しようとする課題は、移動棚やトラックなどが所定の位置からずれていても、後から荷積載位置を補正することができる搬送車を提供することにある。

【課題を解決するための手段】

【0006】

上記課題を解決するために、本発明に係る搬送車は、
荷積載部と、
荷積載部に積載された荷と、荷積載位置とにレーザを照射することができる位置に配置され、水平にレーザを照射して点群を取得する点群取得部と、
取得された点群に基づいて、荷積載部に積載された荷と、荷積載位置に隣接している物との間の左右方向の距離を特定する距離特定部と、を備えている。

【0007】

上記搬送車は、例えば、
搬送車が、フォークリフトであって、バックレストを備え、点群取得部は、バックレストに設けられている。

【0008】

上記搬送車は、好ましくは、
連結部をさらに備え、連結部は、バックレストおよび点群取得部に連結され、点群取得部を、平面視、バックレストの左右いずれかの端部の斜め後ろに配置させる。

【0009】

上記搬送車は、好ましくは、
距離特定部が、取得された点群に基づいて、荷積載部に積載された荷と、荷積載位置に隣接している物との間の前後方向の距離をさらに特定する。

【0010】

上記課題を解決するために、本発明に係る距離特定方法は、
搬送車の荷積載部に積載された荷と、荷積載位置に隣接している物との間の左右方向の距離特定方法であって、荷積載部に積載された荷と、荷積載位置に隣接している物とに、水平にレーザを照射して点群を取得するステップと、取得された点群に基づいて、荷積載部に積載された荷と、荷積載位置に隣接している物との間の左右方向の距離を特定するステップと、を含む。

【0011】

上記課題を解決するために、本発明に係る距離特定方法は、
搬送車の荷積載部に積載された荷と、荷積載位置に隣接している物との間の前後方向の距離特定方法であって、荷積載部に積載された荷と、荷積載位置に隣接している物とに、水平にレーザを照射して点群を取得するステップと、取得された点群に基づいて、荷積載部に積載された荷と、荷積載位置に隣接している物との間の前後方向の距離を特定するステップと、を含む。

【0012】

上記課題を解決するために、本発明に係る距離特定プログラムは、
荷積載部と、荷積載部に積載された荷と、荷積載位置とに水平にレーザを照射できるよう構成され、点群を取得する点群取得部と、コンピュータと、を備えた搬送車のコンピュータに、取得された点群に基づいて、荷積載部に積載された荷と、荷積載位置に隣接している物との間の距離を特定するステップを実行させる。

【0013】

上記課題を解決するために、本発明に係る連結部は、
荷積載部と、荷積載部に積載された荷と、荷積載位置とにレーザを水平に照射できるよう構成され、点群を取得する点群取得部と、取得された点群に基づいて、荷積載部に積載された荷と、荷積載位置に隣接している物との間の左右方向の距離を特定する距離特定部と、バックレストと、を備えた搬送車に設けられる連結部であって、連結部は、バックレストの左右いずれかの端部または上端に固定された第１端部と、平面視、第１端部からバックレストの斜め後ろに延びる中間部と、中間部から連続し、点群取得部を支持する第２端部と、を備える。

【発明の効果】

【0014】

本発明に係る搬送車は、荷積載部に積載された荷と、荷積載位置に隣接している物との間の左右方向の距離を特定することができるので、移動棚やトラックなどが所定の位置からずれていても、後から荷積載位置を補正することができる。

【図面の簡単な説明】

【0015】

【図1】本発明の一実施形態に係る荷役車の側面図である。

【図2】制御部の機能ブロック図である。

【図3】連結部を示し、Ａは正面上から見た斜視図であり、Ｂは平面図であり、Ｃは正面図である。

【図4】２次元LiDARセンサのレーザの照射を示す平面図である。

【図5】２次元LiDARセンサのレーザの照射を示す斜視図である。

【図6】Ａは左側の２次元LiDARセンサによって取得された点群を示す図であり、ＢはＡの点群を左右方向のヒストグラムで表示させた図であり、ＣはＡの点群を前後方向のヒストグラムで表示させた図である。

【図7】Ａは左側の２次元LiDARセンサによって取得された別の点群を示した図であり、ＢはＡの点群を左右方向のヒストグラムで表示させた図であり、ＣはＡの点群を前後方向のヒストグラムで表示させた図である。

【図8】Ａは左側の２次元LiDARセンサによって取得されたさらに別の点群を示した図であり、ＢはＡの点群を左右方向のヒストグラムで表示させた図である。

【図9】Ａは左側の２次元LiDARセンサによって取得されたさらに別の点群を示した図であり、ＢはＡの点群を前後方向のヒストグラムで表示させた図であり、ＣはＡの点群を前後方向のヒストグラムで表示させた図である。

【図10】Ａは左側の２次元LiDARセンサによって取得されたさらに別の点群を示した図であり、ＢはＡの点群を前後左右方向のヒストグラムで表示させた図であり、ＣはＡの点群を前後方向のヒストグラムで表示させた図である。

【図11】Ａ、ＢおよびＣは、搬送車の一連の動作をそれぞれ示す図である。

【図12】Ａ、ＢおよびＣは、搬送車の一連の動作をさらにそれぞれ示す図である。

【発明を実施するための形態】

【0016】

以下、添付図を参照しつつ、本発明の搬送車、連結部、距離特定方法および距離特定プログラムの一実施形態について説明する。図中における両矢印Ｘは左右方向を示し、両矢印Ｙは前後方向を示し、両矢印Ｚは上下方向を示している。

【0017】

図１は本実施形態に係る搬送車１の側面図であり、図２は、制御部３０の機能ブロック図である。本実施形態に係る搬送車１は、自律して走行および荷役を行う無人搬送車であるが、単なる一例であって、本発明に係る搬送車１は、これに限定されるものではない。例えば、搬送車１は、有人無人兼用の搬送車１でもよい。

【0018】

図１および図２に示すように、搬送車１は、複数の車輪１０と、車体１１と、駆動部１２と、レーザスキャナ１３と、左右のマスト１４と、リフトブラケット１５と、左右のフォーク１６と、昇降部１７と、バックレスト１８と、サイドシフト部１９と、左右のキャリッジ２０と、左右のリーチレグ２１と、左右の２次元LiDARセンサ２２と、左右の連結部２３と、制御部３０と、を備えている。搬送車１は、リーチ式フォークリフトであるが、これも単なる一例であって、本発明に係る搬送車１は、カウンター式フォークリフトであってもよい。

【0019】

車体１１は、車輪１０の上に配置され、駆動部１２は、車体１１の内部に配置されている。駆動部１２は、車輪１０を回転させたり、停止させたりするよう構成されている。

【0020】

レーザスキャナ１３は、車体１１の上方に配置されており、水平に回転してレーザを照射する。そして、レーザスキャナ１３は、レーザの反射光をスキャンすることにより、施設内に配置されたリフレクタの位置を特定することで搬送車１の現在位置を特定する。

【0021】

左右のマスト１４は、上下に延びるとともに車体１１の前に配置されている。リフトブラケット１５は、左右のフォーク１６を固定させるフィンガーバーを有し、昇降部１７によって左右のマスト１４に沿って昇降させられるよう構成されている。左右のフォーク１６が本発明の「荷積載部」に相当する。なお、本実施形態では、フォーク１６の数は、４本で構成されているが、２本でも６本でもよく特に限定されない。搬送車１は、４本のフォーク１６を備えていることにより、２つのパレット（荷）を同時にすくい上げることができる。

【0022】

バックレスト１８は、枠状で形成されており、上下左右に延びるとともに積載された荷Ｗ１を受けるよう構成されている。なお、図３および図５に示すバックレスト１８は、外枠のみが図示されており、この外枠はフォーク１６よりも左右方向外側に配置されている。

【0023】

サイドシフト部１９は、アクチュエータを有し、アクチュエータによってバックレスト１８をフォーク１６とともに左右方向に移動させるよう構成されている。これにより、サイドシフト部１９は、パレットのフォーク差し込み孔に対するフォーク１６の左右方向の位置を調整したり、荷Ｗ１を積載する位置を調整することができる。アクチュエータは、油圧アクチュエータでも電動アクチュエータでもよく、特に限定されない。

【0024】

左右のキャリッジ２０は、左右のマスト１４の外側にそれぞれ設けられており、左右のリーチレグ２１は、車体１１から前方に延びている。左右のリーチレグ２１の内側には、キャリッジ２０を案内するガイドが設けられており、マスト１４は、不図示のリーチシリンダによってキャリッジ２０とともに前進位置または後退位置に移動させられる。

【0025】

左右の２次元LiDARセンサ２２は、レーザスキャナによって構成されており水平方向に回転しながらレーザを照射するとともに、レーザの反射光をスキャンして２次元LiDARセンサ２２の周囲の物との距離を点群ＰＧで取得することができるよう構成されている。２次元LiDARセンサ２２が、本発明の「点群取得部」に相当する。点群取得部は、例えば、２次元LiDARセンサ２２の代わりに３次元LiDARセンサ、３次元ToF（Time of Flight）カメラでもよく、２次元LiDARセンサに限定されない。

【0026】

図１および図３に示すように、左右の連結部２３は、第１端部２３ａと、中間部２３ｂと、第２端部２３ｃと、を有する。

【0027】

第１端部２３ａは、バックレスト１８の左右端に固定されており、中間部２３ｂは、平面視、第１端部２３ａからバックレスト１８の斜め後ろに延びている。第２端部２３ｃは、中間部２３ｂから連続する水平面を有し、水平面によって２次元LiDARセンサ２２を支持している。

【0028】

中間部２３ｂの長さは、第２端部２３ｃに支持された２次元LiDARセンサ２２がフォーク１６に積載される荷の側面よりも外側に位置するよう構成されている。すなわち、バックレスト１８の横幅が狭く荷がバックレスト１８よりも大きく左右にはみ出すのであれば、中間部２３ｂの長さはそれにともなって長く構成されることなる。

【0029】

図４は、２次元LiDARセンサ２２のレーザの照射範囲ＬＥを示す平面図であり、図５は、２次元LiDARセンサ２２のレーザの照射範囲ＬＥを示す斜視図である。また、図４および図５は、フォーク１６に積載された荷Ｗ１と、その前方の荷積載位置Ｐに隣接して積載されている荷Ｗ２を示している。荷積載位置Ｐは、例えば、荷役予定に含まれる移動棚の所定の積載位置、トラックＴの荷台の所定の積載位置などである。

【0030】

２次元LiDARセンサ２２は、図４および図５に示すように、フォーク１６に積載された荷Ｗ１と、荷積載位置Ｐとにレーザを水平に照射可能な位置に配置されている。そして、２次元LiDARセンサ２２は、水平に回転しながらレーザを照射して反射光を受信することで、照射角度ごとの物体までの距離を取得する。この距離データは、点群ＰＧとして取得される。

【0031】

図６Ａは、左側の２次元LiDARセンサ２２によって取得された点群ＰＧを示す図である。図６Ａ、図６ＢのＸ軸は、左右方向の距離を示し、図６Ａ、図６ＣのＹ軸は、前後方向の距離を示し、また、Ｘ軸とＹ軸の交点（原点）は、２次元LiDARセンサ２２の位置を示している。また、添付図における点群ＰＧは、取得される点群ＰＧの一例を示すためのイメージ図であって、実際に取得された点群ＰＧではない。図６Ａに示すとおり、フォーク１６に積載された荷Ｗ１および荷積載位置Ｐに隣接して積載されている荷Ｗ２の端面に沿って点群ＰＧが取得されている。

【0032】

図１に示すように、制御部３０は、車体１１の内部に配置されている。制御部３０は、記憶装置と、演算部と、メモリと、を有するコンピュータによって構成されている。記憶装置には、コンピュータを本発明の距離特定部３６として動作させる距離特定プログラムが記憶されている。

【0033】

図２に示すように、制御部３０は、記憶部３２と、走行制御部３４と、距離特定部３６と、昇降制御部３８と、サイドシフト制御部４０と、を有する。

【0034】

記憶部３２には、荷役予定が記憶されており、荷役予定には、荷積載位置Ｐが含まれている。また、記憶部３２には、左右の２次元LiDARセンサ２２の位置と、マスト１４の後退位置から前進位置までの距離も含まれている。

【0035】

走行制御部３４は、駆動部１２を制御するよう構成されており、記憶部３２に記憶されている荷積載位置Ｐと、レーザスキャナ１３によって取得された現在位置とを参照して搬送車１を荷積載位置Ｐまで走行させる。

【0036】

距離特定部３６は、取得された点群ＰＧに基づいて、フォーク１６に積載された荷Ｗ１と、荷積載位置Ｐに隣接している物との間の左右方向の距離Ｄ１および前後方向の距離Ｄ２を特定する。距離特定部３６による点群ＰＧの解析方法は、特に限定されない。

【0037】

走行制御部３４は、荷Ｗ１と荷積載位置Ｐに隣接している物との間の距離Ｄ１、Ｄ２と、マスト１４の後退位置から前進位置までの距離と、搬送車１の現在位置とに基づいて、荷下ろしに必要な前進距離を算出し、算出された距離に基づいて搬送車１を前進させてもよい。

【0038】

昇降制御部３８は、昇降部１７を制御するよう構成されており、記憶部３２に記憶されている荷積載位置Ｐに基づいて、昇降部１７によってフォーク１６を昇降させる。

【0039】

サイドシフト制御部４０は、サイドシフト部１９を制御するよう構成されており、距離特定部３６によって特定されたフォーク１６に積載された荷Ｗ１と、荷積載位置Ｐに隣接している物との間の左右方向の距離Ｄ１に基づいて、サイドシフト部１９によって荷Ｗ１を荷積載位置Ｐに隣接している物に寄せたり、離したりする。これにより、荷Ｗ１と荷Ｗ２との間をつめて荷Ｗ１を積載したり、荷Ｗ１がオーバーラッピングする状態を回避させたりすることができる。

【0040】

次に、距離特定部３６が荷Ｗ１と荷Ｗ２との間の左右方向の距離Ｄ１を特定する方法について、図６を参照しつつ説明する。図６Ｂおよび図６Ｃは、図６Ａの点群ＰＧを左右方向および上下方向のヒストグラムで示したものである。

【0041】

図６Ｂに示すように、Ｘ軸における度数分布によれば、中央に分布のない範囲がある。この範囲は、２次元LiDARセンサ２２によるレーザの反射が他の領域よりも極端に低いかまたはなかった領域を示している。そこで、距離特定部３６は、このレーザの反射のない領域を度数分布を用いて特定するとともに、領域の長さＤ１を算出することにより、荷Ｗ１の側面と荷Ｗ２の側面との間の距離Ｄ１を特定することができる。

【0042】

一方、図６Ｃに示すように、Ｙ軸における度数分布によれば、上側と下側とで２つのピーク値が存在することがわかる。したがって、距離特定部３６は、この２つのピーク値の距離Ｄ２を算出することにより、荷Ｗ１の正面と荷Ｗ２の正面との距離Ｄ２を特定することができる。または、上側のピーク値の下側と、下側のピーク値の下側とに点群ＰＧの分布がなくなる境目が存在していることがわかる。そこで、距離特定部３６は、これら境目と境目との距離を算出することにより、荷Ｗ１の正面と荷Ｗ２の正面との距離Ｄ２を特定することができる。

【0043】

このように、距離特定部３６は、２次元LiDARセンサ２２によって取得された点群ＰＧを度数分布を用いて解析することにより、荷Ｗ１と、荷積載位置Ｐに隣接している物との間の左右方向の距離Ｄ１および前後方向の距離Ｄ２を特定することができる。これにより、搬送車１は、移動棚やトラックＴなどが所定の位置からずれていても、後から荷積載位置Ｐを補正することができるので、適切な位置に荷Ｗ１を積載することができる。なお、図６Ｂおよび図６Ｃのヒストグラムは、本明細書における度数分布説明のためのものであって、距離特定部３６がヒストグラムを作成する必要は特にない。

【0044】

図７～図１０は、距離特定部３６による度数分布解析によって取得することができる情報の例を示している。

【0045】

図７Ａは、荷積載位置Ｐがフレーム状のラックであった場合の、２次元LiDARセンサ２２によって取得された点群ＰＧを示している。図７Ａの左側は、２本のフレームにレーザが照射されて取得された２つの点群ＰＧを示している。また、図７Ｂおよび図７Ｃは、取得された点群ＰＧを左右方向および上下方向のヒストグラムで示している。距離特定部３６は、上述と同様の手法により、レーザの反射のない領域の長さを算出することによりフレームの側面と荷Ｗ１の側面との距離Ｄ１を特定する。また、距離特定部３６は、上述と同様の手法により、上下２つのピーク値の距離Ｄ２を算出することにより、フレームの正面と、荷Ｗ１の正面との距離を特定する。

【0046】

また、図８Ａは、２次元LiDARセンサ２２の位置をバックレスト１８の高さの中央に配置した場合の、２次元LiDARセンサ２２によって取得された点群ＰＧを示している。図８Ａの右側には、バックレスト１８の端部へのレーザの反射によって取得された点群ＰＧが示されている。ただし、この場合にも、図８Ｂおよび図８Ｃに示すように、度数分布を用いて解析することにより、左右方向中央にレーザの反射のない領域を特定することができ、上下方向において上側のピークと下側のピークとを特定することができる。したがって、距離特定部３６は、同様の手法により、距離Ｄ１およびＤ２を特定することができる。

【0047】

また、図９Ａは、荷崩れが起こっているなどといった積み込み先空間で異常があった場合の、２次元LiDARセンサ２２によって取得された点群ＰＧを示している。図９Ａの上側には、異常発生箇所へのレーザの反射によって取得された点群ＰＧが示されている。この場合、図９Ｂに示すように、度数分布を用いて解析することにより、左右方向の中央に分布のない領域がないことを特定することができる。このように、距離特定部３６は、度数分布を用いて解析することにより、荷Ｗ１と荷Ｗ２との間に間隙がないこと、具体的には、左側のピーク値と右側のピーク値との間にレーザの反射がない領域がないことを特定することができる。これにより、距離特定部３６は、積み込み先空間で異常があったことを認識することができる。この場合、制御部３０は、搬送車１の荷役動作を中止させてもよい。

【0048】

図１０Ａは、２次元LiDARセンサ２２によって荷Ｗ１のみにレーザが照射され取得された点群ＰＧを示している。図１０Ｂおよび図１０Ｃに示すように、距離特定部３６は、点群ＰＧデータを度数分布を用いて解析することにより、２次元LiDARセンサ２２（原点）から分布のある領域までの領域またはピーク値までの領域を特定する。これにより、距離特定部３６は、特定された領域の距離Ｄ３、Ｄ４を算出することにより、２次元LiDARセンサ２２と荷Ｗ１との間の左右方向の距離Ｄ３および前後方向の距離Ｄ４も特定することができる。

【0049】

従来、LiDARセンサを用いた解析では、予め特定しておいた物体の形状・特徴と、取得された点群ＰＧとの比較、マッチングを行うことにより、周囲の物体とLiDARセンサとの距離を特定している。この手法では、荷下ろし先がフレーム状の細い構造物であるとき、バックレスト１８を含む周囲構造物がLiDARセンサによって検出されたとき、または積み込み先空間で異常があったときに周囲の物体との距離を安定して取得することが難しい。

【0050】

また、従来のLiDARセンサを用いた解析では、予め特定しておいた物体の形状・特徴を認識する手法であるので、荷Ｗ１に対してレーザを照射してレーザが遮られないよう、LiDARセンサの位置が調整されている。そのため、従来の手法では、搬送車１と、荷Ｗ１と、荷積載位置Ｐに隣接している物との互いの位置関係をLiDARセンサのみで取得することはできない。したがって、従来の手法では、別途他の距離測定、干渉確認などを行う必要があり、そのために別途他のセンサなどを配置する必要があった。

【0051】

一方、本発明に係る方法によれば、左右の２次元LiDARセンサ２２のみを用いるだけで、搬送車１と、積載している荷Ｗ１と、荷積載位置Ｐに隣接している物もしくは荷Ｗ２と、の互いの位置関係を取得することができる。しかも、本発明に係る方法によれば、荷下ろし先がフレーム状の細い構造物であるとき、バックレスト１８を含む周囲構造物が２次元LiDARセンサ２２によって検出されたとき、または積み込み先空間で異常があったときにも、常に安定して荷Ｗ１と荷Ｗ２との距離を取得することができる。

【0052】

次に、図１１および図１２を参照して、本発明に係る搬送車１の一連の動作の例について説明する。なお、本説明において、図１１および図１２における搬送車１は、カウンター式フォークリフトとしている。したがって、マスト１４の前後方向の位置は、移動することがないとして説明している。

【0053】

（１）（１－１）図１１Ａに示すように、搬送車１は、荷Ｗ３をすくい上げる前に、左右の２次元LiDARセンサ２２によってレーザを荷Ｗ３に照射する。
（１－２）次に、搬送車１は、取得した点群ＰＧを距離特定部３６によって度数分布を用いて解析することにより、この荷Ｗ３の左右端の位置を特定するとともに荷Ｗ３の左右方向中央の位置を特定する。
（１－３）次に、搬送車１は、距離特定部３６によって荷Ｗ３の左右方向の中央の位置とバックレスト１８の左右方向中央の位置との距離Ｄ５を算出する。
（１－４）さらに、搬送車１は、算出された距離Ｄ５に基づいて、サイドシフト部１９によってフォーク１６を左右方向に移動させ、それによってフォーク１６と荷Ｗ３とのセンターずれを修正する。

【0054】

なお、例えば、搬送車１がサイドフォーク車である場合、搬送車１は、特定した距離Ｄ５に基づいて、走行制御部３４によって車体１１を移動させることにより、フォーク１６と荷Ｗ３とのセンターずれを修正することができる。

【0055】

（２）（２－１）次いで、搬送車１は、荷Ｗ３（Ｗ１）をすくい上げてトラックＴまで搬送するとともに、図１１Ｂに示すように、トラックＴ側の２次元LiDARセンサ２２によってレーザをトラックＴの荷台に向けて照射しながら、トラックＴの荷台に並行して走行する。
（２－２）次に、搬送車１は、取得した点群ＰＧを距離特定部３６によって度数分布を用いて解析することにより、荷台上の荷積載位置Ｐに隣接している物体（荷Ｗ２）の側面を検出するとともに、検出した側面の位置と、２次元LiDARセンサ２２の位置と、荷Ｗ１の位置との互いの位置関係を特定する。
（２－３）次に、搬送車１は、この物体の側面を検出すると、走行制御部３４によって、特定した側面の位置と、２次元LiDARセンサ２２の位置と、荷Ｗ１との位置関係に基いて、トラックＴ側に方向転換する。

【0056】

（３）（３－１）次いで、搬送車１は、図１１Ｃに示すように、荷積載位置Ｐに向かって前進する前に、２次元LiDARセンサ２２によって水平方向にレーザを照射する。
（３－２）次に、搬送車１は、取得した点群ＰＧを距離特定部３６によって度数分布を用いて解析することにより、荷Ｗ１と荷Ｗ２との間の距離Ｄ１を特定し、それによって、荷Ｗ１が荷Ｗ２に干渉することがないか否かを判定する。このとき、上述したように、搬送車１は、異常が発生していることを特定した場合、荷役を中止してもよい。

【0057】

（４）（４－１）次いで、搬送車１は、距離特定部３６によって特定した荷Ｗ１と荷Ｗ２との前後方向の距離Ｄ２に基づいて走行制御部３４によって荷積載位置Ｐまで前進する。
（４－２）次に、搬送車１は、図１２Ａに示すように、荷Ｗ１を下ろす前に、２次元LiDARセンサ２２によってレーザを照射する。
（４－３）次に、搬送車１は、取得した点群ＰＧを距離特定部３６によって度数分布を用いて解析することにより、荷Ｗ１と荷Ｗ２との間の距離Ｄ１を特定する。
（４－４）次に、搬送車１は、特定された距離Ｄ１に基づいて、サイドシフト制御部４０によってサイドシフト部１９の制御量を特定する。

【0058】

これにより、搬送車１は、サイドシフト部１９によって荷Ｗ１を荷Ｗ２に適切に寄せることができる。

【0059】

（５）（５－１）次いで、搬送車１は、図１２Ｂに示すように、サイドシフト部１９によってフォーク１６を左に移動する際に、２次元LiDARセンサ２２によってレーザを照射する。
（５－２）次に、搬送車１は、取得した点群ＰＧを距離特定部３６によって度数分布を用いて解析することにより、２次元LiDARセンサ２２と荷Ｗ１との間の左右方向および前後方向の距離Ｄ３、Ｄ４を算出して、２次元LiDARセンサ２２と荷Ｗ１との位置関係を特定しながらフォーク１６を移動させる。
（５－３）このとき、搬送車１は、サイドシフト部１９によって移動させている間、距離特定部３６によって、２次元LiDARセンサ２２と荷Ｗ１の位置関係が変化することがないか否かを判定する。

【0060】

これにより、搬送車１は、荷Ｗ１がフォーク１６上で滑り始めることを検出することができる。したがって、例えば、搬送車１は、荷Ｗ１をトラックＴのフロントパネルまたはリアパネルといった物に押し当てたことを検出し、この検出後、フォーク１６の移動を停止させることでフロントパネルやリアパネルを破損させることを防止することができる。

【0061】

一方、搬送車１は、荷Ｗ１を荷Ｗ２に押し付けたいのであれば、荷Ｗ１がフォーク１６上で滑り始めることを検出した後、サイドシフト部の移動を停止させるよう構成してもよい。

【0062】

（６）（６－１）次いで、搬送車１は、図１２Ｃに示すように、フォーク１６を荷Ｗ３から引き抜く際に、２次元LiDARセンサ２２によってレーザを照射する。
（６－２）次に、搬送車１は、取得した点群ＰＧを距離特定部３６によって度数分布を用いて解析することにより、２次元LiDARセンサ２２と荷Ｗ３の位置関係とを特定しながらフォーク１６を引き抜く。

【0063】

これにより、搬送車１は、荷Ｗ３がフォーク１６とともに移動することを検出し、それによって、フォーク１６によって荷Ｗ３を引きずることを防止する。

【0064】

以上、説明してきたように、２次元LiDARセンサ２２は、荷Ｗ１と、荷積載位置Ｐとにレーザを照射することができる位置に配置されていることにより、荷Ｗ１と、荷積載位置Ｐに隣接している物（例えば、荷Ｗ２）とにレーザを照射して、荷Ｗ１と、荷積載位置Ｐに隣接している物からの反射光を検出し点群ＰＧを取得することができる。これにより、搬送車は、距離特定部３６によって、取得された点群ＰＧを解析して、荷Ｗ１と荷Ｗ２との距離Ｄ１、Ｄ２を特定することができるので、移動棚やトラックＴなどが所定の位置からずれていても、後から荷積載位置Ｐを補正し、適切に荷役作業を行うことができる。

【0065】

しかも、記憶部３２には、２次元LiDARセンサ２２の位置も記憶されており、距離特定部３６は、取得された点群ＰＧを解析して、荷Ｗ１と荷Ｗ２との距離Ｄ１、Ｄ２だけでなく、荷Ｗ１と２次元LiDARセンサ２２との距離Ｄ３、Ｄ４も特定することができる。すなわち、搬送車１は、荷Ｗ１と、荷Ｗ２と、２次元LiDARセンサ２２（搬送車１）との３つの相対的な位置関係を特定することができる。これにより、搬送車１は、上記（１）～（６）の一連の動作を行うことができる。

【0066】

以上、本発明の搬送車、連結部、距離特定方法および距離特定プログラムの一実施形態について説明してきたが、本発明は上記実施形態に限定されるものではない。例えば、本発明に係る搬送車は、以下の変形例によって実施されてもよい。

【0067】

＜変形例＞
・連結部２３の第２端部２３ｃは、バックレスト１８の上方に位置していなくてもよい。この場合、２次元LiDARセンサ２２によって取得された点群ＰＧは、図８Ａに示された点群ＰＧとなるが、距離特定部３６が荷Ｗ１と荷Ｗ２との間の距離等を特定することができることは、すでに説明したとおりである。また、連結部２３の第１端部２３ａは、バックレスト１８の上端に設けられていてもよい。

【0068】

・２次元LiDARセンサ２２は、例えば、荷積載部１６に積載された荷Ｗ１と、荷積載位置Ｐに隣接している物とにレーザを照射可能な位置に配置されているのであれば、例えば、車体１１、フィンガーバーに固定されていてもよいし、または連結部２３の第１端部２３ａがフォーク１６の上下方向に延びる垂設部１６ａの側面（図１参照）に固定されていてもよい。もしくは、２次元LiDARセンサ２２は、連結部を介して、車体１１、フォーク１６の垂設部１６ａ、フィンガーバーに固定されていてもよい。

【0069】

・荷積載部は、例えば、フォーク１６の代わりにプラテンによって構成されていてもよい。

【符号の説明】

【0070】

Ｗ１ 荷積載部に積載された荷
Ｗ２ 荷積載位置に隣接して積載されている荷
Ｗ３ 荷積載位置に積載されている荷
Ｄ１ 左右方向の距離
Ｄ２ 前後方向の距離
Ｐ 荷積載位置
ＬＥ レーザ照射範囲
ＰＧ 点群
Ｔ トラック
１ 搬送車
１０ 車輪
１１ 車体
１２ 駆動部
１３ レーザスキャナ
１４ マスト
１５ リフトブラケット
１６ フォーク（荷積載部）
１６ａ 垂設部
１７ 昇降部
１８ バックレスト
１９ サイドシフト部
２０ キャリッジ
２１ リーチレグ
２２ ２次元LiDARセンサ（点群取得部）
２３ 連結部
２３ａ 第１端部
２３ｂ 中間部
２３ｃ 第２端部
３０ 制御部
３２ 記憶部
３４ 走行制御部
３６ 距離特定部
３８ 昇降制御部
４０ サイドシフト制御部

【図1】

【図2】

【図3】

【図4】

【図5】

【図6】

【図7】

【図8】

【図9】

【図10】

【図11】

【図12】