JP6050983B2 - Battery exchange robot and control method of battery exchange robot - Google Patents

Battery exchange robot and control method of battery exchange robot Download PDF

Info

Publication number
JP6050983B2
JP6050983B2 JP2012170925A JP2012170925A JP6050983B2 JP 6050983 B2 JP6050983 B2 JP 6050983B2 JP 2012170925 A JP2012170925 A JP 2012170925A JP 2012170925 A JP2012170925 A JP 2012170925A JP 6050983 B2 JP6050983 B2 JP 6050983B2
Authority
JP
Japan
Prior art keywords
battery
detection
data
vehicle
detection mark
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
JP2012170925A
Other languages
Japanese (ja)
Other versions
JP2014031031A (en
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.)
Nidec Sankyo Corp
Original Assignee
Nidec Sankyo 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 Nidec Sankyo Corp filed Critical Nidec Sankyo Corp
Priority to JP2012170925A priority Critical patent/JP6050983B2/en
Priority to CN201380011825.7A priority patent/CN104136286B/en
Priority to KR1020147025808A priority patent/KR101595684B1/en
Priority to PCT/JP2013/069966 priority patent/WO2014021148A1/en
Publication of JP2014031031A publication Critical patent/JP2014031031A/en
Application granted granted Critical
Publication of JP6050983B2 publication Critical patent/JP6050983B2/en
Expired - Fee Related legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • 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
    • Y02EREDUCTION OF GREENHOUSE GAS [GHG] EMISSIONS, RELATED TO ENERGY GENERATION, TRANSMISSION OR DISTRIBUTION
    • Y02E60/00Enabling technologies; Technologies with a potential or indirect contribution to GHG emissions mitigation
    • Y02E60/10Energy storage using batteries

Landscapes

  • Vehicle Cleaning, Maintenance, Repair, Refitting, And Outriggers (AREA)
  • Arrangement Or Mounting Of Propulsion Units For Vehicles (AREA)
  • Charge And Discharge Circuits For Batteries Or The Like (AREA)
  • Secondary Cells (AREA)
  • Electric Propulsion And Braking For Vehicles (AREA)
  • Manipulator (AREA)

Description

本発明は、車両に搭載されるバッテリーを交換するためのバッテリー交換ロボット、および、かかるバッテリー交換ロボットの制御方法に関する。   The present invention relates to a battery exchange robot for exchanging a battery mounted on a vehicle, and a control method for the battery exchange robot.

従来、電気バスに搭載されるバッテリーを交換するためのバッテリー交換装置が提案されている(たとえば、特許文献1参照)。特許文献1に記載のバッテリー交換装置は、バッテリーが搭載されるバッテリートレーと、バッテリートレーを昇降させる垂直リフト装置と、バッテリートレーおよび垂直リフト装置が搭載されるとともに回転可能な回転プラットフォームと、回転プラットフォームが搭載されるとともに水平方向へ移動可能な平行移動プラットフォームとを備えている。電気バスのバッテリーの搭載部には、ドッキング孔が形成され、バッテリートレーには、このドッキング孔に係合可能なドッキングアームが設けられている。バッテリーの交換時には、ドッキングアームがドッキング孔に係合することで、電気バスのバッテリーの搭載部とバッテリートレーとの位置合わせが行われている。   Conventionally, a battery exchange device for exchanging a battery mounted on an electric bus has been proposed (see, for example, Patent Document 1). A battery exchange device described in Patent Document 1 includes a battery tray on which a battery is mounted, a vertical lift device that raises and lowers the battery tray, a rotary platform that is mounted with the battery tray and the vertical lift device, and is rotatable, and a rotary platform And a parallel movement platform movable in the horizontal direction. A docking hole is formed in the battery mounting portion of the electric bus, and a docking arm that can be engaged with the docking hole is provided in the battery tray. When the battery is replaced, the docking arm engages with the docking hole, so that the battery mounting portion of the electric bus and the battery tray are aligned.

特表2008−520173号公報Japanese translation of PCT publication No. 2008-520173

電気バスには、複数のバッテリーが搭載されることがある。特許文献1に記載のバッテリー交換装置では、バッテリーを交換する際にドッキングアームがドッキング孔に係合しているため、電気バスに複数のバッテリーが搭載されていても、複数のバッテリーのそれぞれとバッテリートレーとの位置ずれを防止して、複数のバッテリーのそれぞれを適切に交換することが可能である。しかしながら、特許文献1に記載のバッテリー交換装置では、複数のバッテリーのそれぞれとバッテリートレーとの位置ずれを防止して複数のバッテリーのそれぞれを適切に交換するために、ドッキングアームといった大掛かりな機構が必要になり、その結果、バッテリー交換装置の構成が複雑になる。   A plurality of batteries may be mounted on the electric bus. In the battery exchange device described in Patent Document 1, since the docking arm is engaged with the docking hole when the battery is exchanged, each of the plurality of batteries and the battery can be connected even if a plurality of batteries are mounted on the electric bus. It is possible to appropriately replace each of the plurality of batteries while preventing positional deviation from the tray. However, the battery exchange device described in Patent Document 1 requires a large-scale mechanism such as a docking arm in order to prevent the positional deviation between each of the plurality of batteries and the battery tray and appropriately replace each of the plurality of batteries. As a result, the configuration of the battery exchange device becomes complicated.

そこで、本発明の課題は、構成が簡易であっても、車両に搭載される複数のバッテリーのそれぞれを適切に交換することが可能なバッテリー交換ロボットを提供することにある。また、本発明の課題は、バッテリー交換ロボットの構成が簡易であっても、車両に搭載される複数のバッテリーのそれぞれを適切に交換することが可能となるバッテリー交換ロボットの制御方法を提供することにある。   Accordingly, an object of the present invention is to provide a battery exchange robot capable of appropriately replacing each of a plurality of batteries mounted on a vehicle even if the configuration is simple. Another object of the present invention is to provide a method for controlling a battery exchange robot that can appropriately replace each of a plurality of batteries mounted on a vehicle even if the configuration of the battery exchange robot is simple. It is in.

上記の課題を解決するため、本発明のバッテリー交換ロボットは、車両に搭載されている複数のバッテリーを交換するためのバッテリー交換ロボットであって、車両からの複数のバッテリーのそれぞれの引抜きおよび/または車両への複数のバッテリーのそれぞれの差込みを行うバッテリー抜差機構と、車両に取り付けられるとともに複数のバッテリーのそれぞれが搭載される複数のバッテリー置き台のそれぞれに形成される複数の検出用マークのそれぞれを検出するための検出機構と、バッテリー交換ロボットを制御する制御部とを備え、制御部は、バッテリー抜差機構による複数のバッテリーのそれぞれの引抜きおよび/または差込みを行うために所定の基準位置に停止する車両を用いてバッテリー交換ロボットに教示された抜差位置の教示データである抜差位置教示データと、バッテリーが実際に交換される車両の複数の検出用マークのそれぞれの検出を検出機構によって行うときの基準となる検出用位置のデータである検出用位置データとを記憶するとともに、複数のバッテリーのうちの交換対象となる1つのバッテリーを第1バッテリーとし、第1バッテリーの引抜きおよび/または差込みを行うための抜差位置教示データを第1抜差位置教示データとし、複数の検出用マークのうちの第1バッテリーが搭載されるバッテリー置き台に形成される検出用マークを第1検出用マークとし、第1検出用マークの検出を行うときの検出用位置データを第1検出用位置データとすると、制御部は、バッテリーが実際に交換される車両に対する第1バッテリーの抜差し時に、第1検出用位置データを第1バッテリーの交換用のデータとして読み出し、第1検出用位置データを基準にしてバッテリー交換ロボットを動作させて第1検出用マークの検出を行うとともに、第1検出用マークの検出結果に基づいて、第1抜差位置教示データを補正し、補正後の第1抜差位置教示データに基づいてバッテリー交換ロボットを動作させることを特徴とする。   In order to solve the above-described problem, the battery exchange robot of the present invention is a battery exchange robot for exchanging a plurality of batteries mounted on a vehicle, and each of the batteries is pulled out and / or removed from the vehicle. A battery insertion / removal mechanism that inserts a plurality of batteries into a vehicle, and a plurality of detection marks that are attached to the vehicle and that are formed on each of a plurality of battery mounts on which the plurality of batteries are mounted. And a control unit that controls the battery exchange robot, and the control unit is provided at a predetermined reference position in order to pull out and / or insert a plurality of batteries by the battery insertion / removal mechanism. Using the vehicle to stop, the position of the slip position taught to the battery replacement robot Differential position teaching data which is display data and detection position data which is reference position data when the detection mechanism detects each of a plurality of detection marks of a vehicle in which the battery is actually replaced. Is stored as one of the plurality of batteries, and a replacement battery position teaching data for pulling out and / or inserting the first battery is used as the first battery position teaching data. The detection position when detecting the first detection mark using the detection mark formed on the battery mount on which the first battery is mounted among the plurality of detection marks as the first detection mark. When the data is the first detection position data, the control unit performs the first detection when the first battery is inserted into or removed from the vehicle in which the battery is actually replaced. Position data is read as replacement data for the first battery, the battery replacement robot is operated based on the first detection position data to detect the first detection mark, and the first detection mark is detected. Based on the result, the first draft position teaching data is corrected, and the battery replacement robot is operated based on the corrected first draft position teaching data.

また、上記の課題を解決するため、本発明のバッテリー交換ロボットの制御方法は、車両に搭載されている複数のバッテリーのそれぞれの引抜きおよび/または車両への複数のバッテリーのそれぞれの差込みを行うバッテリー抜差機構と、車両に取り付けられるとともに複数のバッテリーのそれぞれが搭載される複数のバッテリー置き台のそれぞれに形成される複数の検出用マークのそれぞれを検出するための検出機構とを備え、車両に搭載されているバッテリーを交換するバッテリー交換ロボットの制御方法であって、バッテリー抜差機構による複数のバッテリーのそれぞれの引抜きおよび/または差込みを行うために所定の基準位置に停止する車両を用いてバッテリー交換ロボットに教示された抜差位置の教示データである抜差位置教示データと、バッテリーが実際に交換される車両の複数の検出用マークのそれぞれの検出を検出機構によって行うときの基準となる検出用位置のデータである検出用位置データとを記憶するとともに、複数のバッテリーのうちの交換対象となる1つのバッテリーを第1バッテリーとし、第1バッテリーの引抜きおよび/または差込みを行うための抜差位置教示データを第1抜差位置教示データとし、複数の検出用マークのうちの第1バッテリーが搭載されるバッテリー置き台に形成される検出用マークを第1検出用マークとし、第1検出用マークの検出を行うときの検出用位置データを第1検出用位置データとすると、バッテリーが実際に交換される車両に対する第1バッテリーの抜差し時に、第1検出用位置データを第1バッテリーの交換用のデータとして読み出し、第1検出用位置データを基準にしてバッテリー交換ロボットを動作させて第1検出用マークの検出を行うとともに、第1検出用マークの検出結果に基づいて、第1抜差位置教示データを補正し、補正後の第1抜差位置教示データに基づいてバッテリー交換ロボットを動作させることを特徴とする。   In addition, in order to solve the above-described problems, the battery exchange robot control method according to the present invention is a battery that pulls out a plurality of batteries mounted on a vehicle and / or inserts a plurality of batteries into the vehicle. The vehicle includes a pull-out mechanism and a detection mechanism that is attached to the vehicle and detects each of a plurality of detection marks formed on each of the plurality of battery mounts on which the plurality of batteries are mounted. A method for controlling a battery exchanging robot for exchanging an on-board battery, the battery using a vehicle that stops at a predetermined reference position in order to pull out and / or insert each of a plurality of batteries by a battery insertion / removal mechanism Pull-out position teaching that is teaching data of the pull-out position taught to the exchange robot And detection position data that is reference position data when the detection mechanism detects each of the plurality of detection marks of the vehicle in which the battery is actually replaced. One of the batteries to be replaced is the first battery, and the insertion position teaching data for pulling out and / or inserting the first battery is the first insertion position teaching data, for a plurality of detections. Of the marks, the detection mark formed on the battery mount on which the first battery is mounted is used as the first detection mark, and the detection position data when detecting the first detection mark is the first detection position. As data, when the first battery is inserted into or removed from the vehicle where the battery is actually replaced, the first detection position data is used for replacing the first battery. The data is read as data, and the battery replacement robot is operated on the basis of the first detection position data to detect the first detection mark, and based on the detection result of the first detection mark, the first slip position teaching is performed. The data exchange is corrected, and the battery exchange robot is operated based on the corrected first draw position teaching data.

本発明では、バッテリーが実際に交換される車両に対する第1バッテリーの抜差し時に、複数の検出用マークのうちの第1バッテリーが搭載されるバッテリー置き台に形成される第1検出用マークの検出を行うときの第1検出用位置データを第1バッテリーの交換用のデータとして読み出し、第1検出用位置データを基準にしてバッテリー交換ロボットを動作させて第1検出用マークの検出を行うとともに、第1検出用マークの検出結果に基づいて、第1抜差位置教示データを補正し、補正後の第1抜差位置教示データに基づいてバッテリー交換ロボットを動作させている。   In the present invention, when the first battery is inserted into or removed from the vehicle in which the battery is actually replaced, detection of the first detection mark formed on the battery mount on which the first battery is mounted is detected. First position data for detection is read as replacement data for the first battery, and the battery replacement robot is operated based on the first detection position data to detect the first detection mark. Based on the detection result of the 1 detection mark, the first differential position teaching data is corrected, and the battery replacement robot is operated based on the corrected first differential position teaching data.

すなわち、本発明では、交換されるバッテリーが搭載されるバッテリー置き台に形成される検出用マークの検出結果に基づいて、交換されるバッテリーの抜差位置教示データを補正し、補正後の抜差位置教示データに基づいてバッテリー交換ロボットを動作させている。そのため、バッテリーにより近い位置に形成される検出用マークの検出結果に基づいて、交換されるバッテリーの抜差位置教示データを精度良く補正するとともに、精度良く補正された抜差位置教示データに基づいてバッテリー交換ロボットを精度良く動作させることが可能になる。したがって、本発明では、特許文献1に記載のバッテリー交換装置が有するドッキングアームをバッテリー交換ロボットが備えていなくても、車両に搭載される複数のバッテリーのそれぞれを適切に交換することが可能になる。すなわち、本発明では、バッテリー交換ロボットの構成が簡易であっても、車両に搭載される複数のバッテリーのそれぞれを適切に交換することが可能になる。また、本発明では、交換されるバッテリーが搭載されるバッテリー置き台に形成される検出用マークの検出後に、バッテリーの交換動作に移ることが可能であるため、バッテリーの交換時間を短縮することが可能になる。   That is, according to the present invention, based on the detection result of the detection mark formed on the battery mount on which the battery to be replaced is mounted, the replacement position teaching data of the battery to be replaced is corrected, and the corrected plug The battery exchange robot is operated based on the position teaching data. Therefore, based on the detection result of the detection mark formed at a position closer to the battery, the replacement position teaching data of the battery to be replaced is accurately corrected, and based on the corrected correction position teaching data. It becomes possible to operate the battery exchange robot with high accuracy. Therefore, according to the present invention, even if the battery exchange robot does not include the docking arm included in the battery exchange device described in Patent Document 1, it is possible to appropriately replace each of the plurality of batteries mounted on the vehicle. . That is, according to the present invention, even if the configuration of the battery replacement robot is simple, it is possible to appropriately replace each of the plurality of batteries mounted on the vehicle. Further, in the present invention, it is possible to shift to a battery replacement operation after detecting a detection mark formed on a battery cradle on which a battery to be replaced is mounted, so that the battery replacement time can be shortened. It becomes possible.

本発明において、基準位置に停止する車両を用い検出機構によって実際に検出される車両の位置である車両基準位置と、バッテリーが実際に交換される車両の、検出機構によって検出される位置である車両実際位置との差を車両位置偏差とすると、たとえば、制御部は、複数の検出用マークのそれぞれの位置を検出するために基準位置に停止する車両を用いバッテリー交換ロボットに教示された検出用マーク教示位置と車両位置偏差とに基づいて、検出用位置を算出する。   In the present invention, a vehicle reference position that is a position of a vehicle that is actually detected by the detection mechanism using a vehicle that stops at the reference position, and a vehicle that is a position detected by the detection mechanism of a vehicle in which the battery is actually replaced. If the difference from the actual position is the vehicle position deviation, for example, the control unit uses the vehicle that stops at the reference position to detect the position of each of the plurality of detection marks, and the detection mark taught to the battery replacement robot. A detection position is calculated based on the teaching position and the vehicle position deviation.

本発明において、制御部は、基準位置に停止する車両を用い検出機構によって実際に検出される検出用マークの位置である検出用マーク基準位置のデータである検出用マーク基準位置データを記憶するとともに、検出機構によって検出される第1検出用マークの位置である検出用マーク基準位置としての第1検出用マーク基準位置のデータを第1検出用マーク基準位置データとすると、制御部は、バッテリーが実際に交換される車両に対する第1バッテリーの抜差し時に、第1検出用マーク基準位置データを第1バッテリーの交換用のデータとして読み出して、第1検出用マークの検出結果と第1検出用マーク基準位置データとに基づいて第1抜差位置教示データを補正することが好ましい。このように構成すると、交換されるバッテリーの抜差位置教示データをより精度良く補正することが可能になる。   In the present invention, the control unit stores detection mark reference position data that is detection mark reference position data that is a position of a detection mark that is actually detected by a detection mechanism using a vehicle that stops at the reference position. When the data of the first detection mark reference position as the detection mark reference position, which is the position of the first detection mark detected by the detection mechanism, is the first detection mark reference position data, the control unit When the first battery is inserted into or removed from the vehicle to be actually replaced, the first detection mark reference position data is read as the first battery replacement data, and the detection result of the first detection mark and the first detection mark reference are read out. It is preferable to correct the first draft position teaching data based on the position data. If comprised in this way, it will become possible to correct | amend the insertion / extraction position teaching data of the battery to be replaced with higher accuracy.

この場合には、たとえば、バッテリーが実際に交換される車両の第1検出用マークの、検出機構によって検出される位置である第1検出用マーク実際位置と第1検出用マーク基準位置との差を第1検出用マーク位置偏差とすると、制御部は、第1バッテリーの引抜きおよび/または差込みを行うための抜差位置である第1抜差位置を第1検出用マーク位置偏差に基づいて補正した第1補正位置を算出して第1抜差位置教示データを補正する。   In this case, for example, the difference between the first detection mark actual position which is the position detected by the detection mechanism and the first detection mark reference position of the first detection mark of the vehicle where the battery is actually replaced. Is the first detection mark position deviation, the control unit corrects the first extraction position, which is the extraction position for removing and / or inserting the first battery, based on the first detection mark position deviation. The first corrected position is calculated to correct the first draft position teaching data.

また、本発明のバッテリー交換ロボットの制御方法では、基準位置に停止する車両を用い検出機構によって実際に検出される検出用マークの位置である検出用マーク基準位置のデータである検出用マーク基準位置データを記憶するとともに、検出機構によって実際に検出される第1検出用マークの位置である検出用マーク基準位置としての第1検出用マーク基準位置のデータを第1検出用マーク基準位置データとすると、バッテリーが実際に交換される車両に対する第1バッテリーの抜差し時に、第1検出用マーク基準位置データを第1バッテリーの交換用のデータとして読み出して、第1検出用マークの検出結果と第1検出用マーク基準位置データとに基づいて第1抜差位置教示データを補正することが好ましい。このように構成すると、交換されるバッテリーの抜差位置教示データをより精度良く補正することが可能になる。   In the battery exchange robot control method of the present invention, the detection mark reference position which is data of the detection mark reference position which is the position of the detection mark actually detected by the detection mechanism using the vehicle stopped at the reference position. The data is stored, and the data of the first detection mark reference position as the detection mark reference position, which is the position of the first detection mark actually detected by the detection mechanism, is the first detection mark reference position data. When the first battery is inserted into or removed from the vehicle in which the battery is actually replaced, the first detection mark reference position data is read as the first battery replacement data, and the detection result of the first detection mark and the first detection are detected. It is preferable to correct the first draft position teaching data based on the mark reference position data. If comprised in this way, it will become possible to correct | amend the insertion / extraction position teaching data of the battery to be replaced with higher accuracy.

以上のように、本発明では、バッテリー交換ロボットの構成が簡易であっても、車両に搭載される複数のバッテリーのそれぞれを適切に交換することが可能になる。   As described above, according to the present invention, even if the configuration of the battery replacement robot is simple, it is possible to appropriately replace each of the plurality of batteries mounted on the vehicle.

本発明の実施の形態にかかるバッテリー交換システムの斜視図である。1 is a perspective view of a battery exchange system according to an embodiment of the present invention. 図1のE部を別の角度から示す斜視図である。It is a perspective view which shows the E section of FIG. 1 from another angle. 図2のF部の拡大図である。It is an enlarged view of the F section of FIG. 図1に示すバッテリー収容部にバッテリーが収容された状態を示す正面図である。It is a front view which shows the state in which the battery was accommodated in the battery accommodating part shown in FIG. 図4のG部の拡大図である。It is an enlarged view of the G section of FIG. 図2に示すバッテリー抜差機構および昇降機構を正面から示す図である。It is a figure which shows the battery insertion / extraction mechanism and lifting mechanism shown in FIG. 2 from the front. 図6のH−H方向からバッテリー抜差機構および昇降機構を示す図である。It is a figure which shows a battery insertion / extraction mechanism and a raising / lowering mechanism from the HH direction of FIG. 図6に示すバッテリー搭載機構を正面から説明するための図である。It is a figure for demonstrating the battery mounting mechanism shown in FIG. 6 from the front. 図6に示すバッテリー搭載機構を側面から説明するための図である。It is a figure for demonstrating the battery mounting mechanism shown in FIG. 6 from a side surface. 図6に示すバッテリー搭載機構を上面から説明するための図である。It is a figure for demonstrating the battery mounting mechanism shown in FIG. 6 from the upper surface. 図8に示すローラの拡大断面図である。It is an expanded sectional view of the roller shown in FIG. 図6に示すバッテリー移動機構を正面から説明するための図である。It is a figure for demonstrating the battery moving mechanism shown in FIG. 6 from the front. 図6に示すバッテリー移動機構を側面から説明するための図である。It is a figure for demonstrating the battery moving mechanism shown in FIG. 6 from a side surface. 図13に示すバッテリー係合部がバスから離れる方向へ移動したときの状態を側面から説明するための図である。It is a figure for demonstrating a state when the battery engaging part shown in FIG. 13 moves to the direction away from a bus | bath from a side surface. 図13のJ部の拡大図である。It is an enlarged view of the J section of FIG. 図13のK部の拡大図である。It is an enlarged view of the K section of FIG. 図6に示すバッテリー移動機構を上面から説明するための図である。It is a figure for demonstrating the battery moving mechanism shown in FIG. 6 from an upper surface. (A)は、図17のM部の拡大図であり、(B)は、図17のN部の拡大図である。(A) is an enlarged view of a portion M in FIG. 17, and (B) is an enlarged view of a portion N in FIG. 図10に示す検出機構によるバスの位置検出時の状態を上面から示す図である。It is a figure which shows the state at the time of the position detection of the bus | bath by the detection mechanism shown in FIG. 10 from an upper surface. 図10に示す検出機構によるバスの位置検出方法を説明するための概略図である。It is the schematic for demonstrating the bus position detection method by the detection mechanism shown in FIG. 図10に示す検出機構によるバッテリーの位置検出時の状態を上面から示す図である。It is a figure which shows the state at the time of the position detection of the battery by the detection mechanism shown in FIG. 10 from an upper surface. 図10に示す検出機構によるバッテリーの位置検出方法を説明するための図である。It is a figure for demonstrating the battery position detection method by the detection mechanism shown in FIG. 図2に示すバッテリー交換ロボットのバッテリー交換動作の概略フローを示すフローチャートである。It is a flowchart which shows the schematic flow of the battery replacement | exchange operation | movement of the battery replacement robot shown in FIG. 図2に示すバッテリー交換ロボットによるバスからのバッテリーの引抜き動作を説明するための図である。It is a figure for demonstrating the extraction operation | movement of the battery from the bus | bath by the battery exchange robot shown in FIG. 図2に示すバッテリー交換ロボットによるバスへのバッテリーの差込み動作を説明するための図である。It is a figure for demonstrating the insertion operation of the battery to the bus | bath by the battery exchange robot shown in FIG. 図2に示すバッテリー交換ロボットによるバスからのバッテリーの引抜き動作時のバッテリー搭載部およびバッテリー係合部の動作の軌跡を説明するための図である。It is a figure for demonstrating the locus | trajectory of operation | movement of the battery mounting part and battery engaging part at the time of battery extraction operation | movement from the bus | bath by the battery exchange robot shown in FIG. 図2に示すバッテリー交換ロボットによるバスへのバッテリーの差込み動作時のバッテリー搭載部およびバッテリー係合部の動作の軌跡を説明するための図である。It is a figure for demonstrating the locus | trajectory of operation | movement of the battery mounting part and battery engaging part at the time of the battery insertion operation | movement to the bus | bath by the battery exchange robot shown in FIG. 図2に示すバッテリー交換ロボットによるバスからのバッテリーの引抜き動作時のバッテリー搭載部およびバッテリー係合部の動作の軌跡であってバッテリー検出位置を経由する場合の軌跡を説明するための図である。It is a figure for demonstrating the locus | trajectory at the time of passing through a battery detection position, when it is a locus | trajectory of the operation | movement of the battery mounting part and battery engaging part at the time of battery extraction operation | movement from the bus | bath by the battery exchange robot shown in FIG. 図2に示すバッテリー収容部の正面図である。It is a front view of the battery accommodating part shown in FIG. 図2に示すバッテリー交換ロボットの制御部の記憶部および第2記憶部に記憶されているデータの一部を説明するためのブロック図である。It is a block diagram for demonstrating a part of data memorize | stored in the memory | storage part and 2nd memory | storage part of the control part of the battery exchange robot shown in FIG. 図2に示すバッテリー交換ロボットの制御方法の一例を説明するためのフローチャートである。3 is a flowchart for explaining an example of a control method for the battery exchange robot shown in FIG. 2. (A)は、本発明の他の実施の形態にかかる検出用マークを正面から説明するための図であり、(B)は(A)のW−W断面の断面図である。(A) is a figure for demonstrating from the front the detection mark concerning other embodiment of this invention, (B) is sectional drawing of the WW cross section of (A).

以下、図面を参照しながら、本発明の実施の形態を説明する。   Hereinafter, embodiments of the present invention will be described with reference to the drawings.

(バッテリー交換システムの概略構成)
図1は、本発明の実施の形態にかかるバッテリー交換システム1の斜視図である。図2は、図1のE部を別の角度から示す斜視図である。以下の説明では、互いに直交する3方向のそれぞれをX方向、Y方向およびZ方向とする。本形態では、Z方向が上下方向(鉛直方向)と一致する。また、以下の説明では、X方向を前後方向、Y方向を左右方向とする。
(Schematic configuration of battery replacement system)
FIG. 1 is a perspective view of a battery exchange system 1 according to an embodiment of the present invention. FIG. 2 is a perspective view showing the E portion of FIG. 1 from another angle. In the following description, each of the three directions orthogonal to each other is defined as an X direction, a Y direction, and a Z direction. In this embodiment, the Z direction coincides with the vertical direction (vertical direction). In the following description, the X direction is the front-rear direction and the Y direction is the left-right direction.

本形態のバッテリー交換システム1は、車両2に搭載されているバッテリー3を交換するためのシステムである。本形態の車両2は、電気バスである。したがって、以下では、車両2を「バス2」とする。バス2には、複数のバッテリー3が収容されるバッテリー収容部4が取り付けられている。バッテリー収容部4は、バス2の一方の側面2aに取り付けられるカバー部材(図示省略)を取り外すと、側面2aに露出するように配置されている。また、バッテリー収容部4は、バス2の座席の下側に配置されている。バッテリー3の交換時には、バス2は、その進行方向と左右方向とが略一致するように停止している。   The battery exchange system 1 of this embodiment is a system for exchanging the battery 3 mounted on the vehicle 2. The vehicle 2 of this embodiment is an electric bus. Therefore, hereinafter, the vehicle 2 is referred to as “bus 2”. A battery housing portion 4 in which a plurality of batteries 3 are housed is attached to the bus 2. The battery accommodating portion 4 is arranged so as to be exposed to the side surface 2a when a cover member (not shown) attached to one side surface 2a of the bus 2 is removed. Further, the battery accommodating portion 4 is disposed below the seat of the bus 2. When the battery 3 is replaced, the bus 2 is stopped so that the traveling direction thereof substantially coincides with the left-right direction.

バッテリー交換システム1は、バッテリー収容部4に収容されているバッテリー3を交換するためのバッテリー交換ロボット5(以下、「ロボット5」とする。)を備えている。ロボット5は、バッテリー収容部4に収容されているバッテリー3の交換が可能となるように、前後方向でバス2の側面2aと向き合っている。このロボット5は、バッテリー収容部4に収容されているバッテリー3を引き抜いて、図示を省略するバッファステーションへ搬入するとともに、バッファステーションに収容された充電済みのバッテリー3をバッファステーションから搬出してバッテリー収容部4に差し込む。   The battery exchanging system 1 includes a battery exchanging robot 5 (hereinafter referred to as “robot 5”) for exchanging the battery 3 accommodated in the battery accommodating portion 4. The robot 5 faces the side surface 2a of the bus 2 in the front-rear direction so that the battery 3 housed in the battery housing portion 4 can be replaced. The robot 5 pulls out the battery 3 housed in the battery housing portion 4 and carries it into a buffer station (not shown), and unloads the charged battery 3 housed in the buffer station from the buffer station. Insert into the housing 4.

なお、バス2の側面2aには、バス2の位置を検出するための検出用プレート9が形成または固定されている。検出用プレート9は、平板状に形成されるとともに、上下方向でその幅が略一定な略矩形状に形成されている。この検出用プレート9は、たとえば、バス2の進行方向におけるバッテリー収容部4の手前側に配置されている。また、検出用プレート9は、側面2aに取り付けられるカバー部材(図示省略)を取り外すと、側面2aに露出するように配置されている。   A detection plate 9 for detecting the position of the bus 2 is formed or fixed on the side surface 2 a of the bus 2. The detection plate 9 is formed in a flat plate shape, and is formed in a substantially rectangular shape having a substantially constant width in the vertical direction. This detection plate 9 is disposed, for example, on the front side of the battery housing portion 4 in the traveling direction of the bus 2. Further, the detection plate 9 is disposed so as to be exposed to the side surface 2a when a cover member (not shown) attached to the side surface 2a is removed.

(バッテリーおよびバッテリー収容部の構成)
図3は、図2のF部の拡大図である。図4は、図1に示すバッテリー収容部4にバッテリー3が収容された状態を示す正面図である。図5は、図4のG部の拡大図である。
(Configuration of battery and battery compartment)
FIG. 3 is an enlarged view of a portion F in FIG. FIG. 4 is a front view showing a state in which the battery 3 is accommodated in the battery accommodating portion 4 shown in FIG. FIG. 5 is an enlarged view of a portion G in FIG.

バッテリー収容部4は、バッテリー3が搭載されるバッテリー置き台6と、左右の側壁7とを備えており、バッテリー置き台6と側壁7とによって、バッテリー3の収容空間が形成されている。バッテリー収容部4には、複数のバッテリー3の収容空間が形成されており、複数のバッテリー3が収容可能となっている。すなわち、バス2には、複数のバッテリー3が搭載可能となっている。本形態のバス2には、4個のバッテリー3が搭載可能となっており、バッテリー収容部4は、4個のバッテリー3のそれぞれが搭載される4個のバッテリー置き台6を備えている。また、本形態では、2個のバッテリー置き台6が側壁7を介して左右方向で隣接するように配置されるとともに、左右方向で隣接する2個のバッテリー置き台6と、左右方向で隣接する他の2個のバッテリー置き台6とが上下方向で重なるように配置されている。   The battery housing portion 4 includes a battery cradle 6 on which the battery 3 is mounted, and left and right side walls 7, and a housing space for the battery 3 is formed by the battery cradle 6 and the side walls 7. The battery accommodating portion 4 is formed with accommodating spaces for a plurality of batteries 3 so that a plurality of batteries 3 can be accommodated. That is, a plurality of batteries 3 can be mounted on the bus 2. Four batteries 3 can be mounted on the bus 2 of this embodiment, and the battery housing portion 4 includes four battery mounts 6 on which each of the four batteries 3 is mounted. Further, in this embodiment, the two battery mounts 6 are disposed so as to be adjacent in the left-right direction via the side wall 7 and are adjacent to the two battery mounts 6 adjacent in the left-right direction in the left-right direction. The other two battery mounts 6 are arranged so as to overlap in the vertical direction.

バッテリー置き台6の前面には、バッテリー3の位置を間接的に検出するための検出用マーク8が形成されている。検出用マーク8は、バッテリー置き台6の左右方向の両端側のそれぞれに形成されている。すなわち、左右方向に所定の間隔をあけた状態で、一対の(2個の)検出用マーク8がバッテリー置き台6の前面に形成されている。上述のように、本形態のバッテリー収容部4は、4個のバッテリー置き台6を備えており、バッテリー収容部4には、4組の一対の検出用マーク8が形成されている。また、検出用マーク8は、図3に示すように、バッテリー置き台6の前面よりも突出する平板状に形成されるとともに、上下方向でその幅が変化する略三角形状に形成されている。具体的には、検出用マーク8は、上側に向かうにしたがって、その幅が狭くなる略正三角形状に形成されている。   A detection mark 8 for indirectly detecting the position of the battery 3 is formed on the front surface of the battery mount 6. The detection mark 8 is formed on each of both ends in the left-right direction of the battery mount 6. That is, a pair of (two) detection marks 8 are formed on the front surface of the battery stand 6 with a predetermined interval in the left-right direction. As described above, the battery housing portion 4 of this embodiment includes the four battery mounts 6, and the battery housing portion 4 is formed with four pairs of detection marks 8. Further, as shown in FIG. 3, the detection mark 8 is formed in a flat plate shape that protrudes from the front surface of the battery mount 6, and is formed in a substantially triangular shape whose width changes in the vertical direction. Specifically, the detection mark 8 is formed in a substantially equilateral triangle shape whose width becomes narrower toward the upper side.

バッテリー3の前面には、バッテリー収容部4からバッテリー3を引き抜くための取手部11が形成されている。本形態では、バッテリー3の前面の、左右方向の両端側のそれぞれに取手部11が形成されている。バッテリー3の下面には、ロボット5によって引き抜かれたバッテリー3の、引抜き方向に直交する方向の位置決めを行うための突起部12が下方向へ突出するように形成されている(図5参照)。また、バッテリー3は、バッテリー収容部4にバッテリー3を固定するための固定部材13(図4参照)と、バッテリー収容部4に対するバッテリー3の固定状態を解除するための解除部材14(図3参照)とを備えている。   A handle 11 for pulling out the battery 3 from the battery housing 4 is formed on the front surface of the battery 3. In the present embodiment, the handle portion 11 is formed on each of the left and right ends of the front surface of the battery 3. On the lower surface of the battery 3, a protrusion 12 for positioning the battery 3 pulled out by the robot 5 in a direction orthogonal to the pulling direction is formed so as to protrude downward (see FIG. 5). The battery 3 includes a fixing member 13 (see FIG. 4) for fixing the battery 3 to the battery housing portion 4 and a release member 14 (see FIG. 3) for releasing the fixed state of the battery 3 with respect to the battery housing portion 4. ).

固定部材13は、バッテリー3の左右の側面のそれぞれから突出するようにバッテリー3に取り付けられている。また、固定部材13は、バッテリー3の前面側に取り付けられている。この固定部材13は、左右方向へ移動可能となるようにバッテリー3に保持されている。また、固定部材13は、図示を省略する付勢部材によって左右方向の外側へ付勢されている。本形態では、この付勢部材の付勢力によって、バッテリー収容部4の側壁7に形成される係合孔に固定部材13の左右の外側端部分が係合することで、バッテリー収容部4にバッテリー3が固定されている。固定部材13は、バッテリー収容部4の中で、前後方向および上下方向におけるバッテリー3の位置決めを行う機能を果たしている。   The fixing member 13 is attached to the battery 3 so as to protrude from the left and right side surfaces of the battery 3. The fixing member 13 is attached to the front side of the battery 3. The fixing member 13 is held by the battery 3 so as to be movable in the left-right direction. The fixing member 13 is urged outward in the left-right direction by an urging member (not shown). In this embodiment, the urging force of the urging member causes the right and left outer end portions of the fixing member 13 to engage with the engagement holes formed in the side wall 7 of the battery housing portion 4, thereby 3 is fixed. The fixing member 13 functions to position the battery 3 in the front-rear direction and the up-down direction in the battery housing portion 4.

解除部材14は、取手部11の奥側に配置されている。この解除部材14は、前後方向へ移動可能となるようにバッテリー3に保持されている。また、解除部材14は、図示を省略する付勢部材によってバッテリー3の前面側へ付勢されている。本形態では、解除部材14が奥側へ押されると、固定部材13が左右方向の内側へ移動して、バッテリー収容部4の側壁7に形成される係合孔と固定部材13との係合状態が解除され、バッテリー収容部4からのバッテリー3の引抜きが可能となる。   The release member 14 is disposed on the back side of the handle portion 11. The release member 14 is held by the battery 3 so as to be movable in the front-rear direction. The release member 14 is urged toward the front side of the battery 3 by an urging member (not shown). In this embodiment, when the release member 14 is pushed to the back side, the fixing member 13 moves inward in the left-right direction, and the engagement hole formed in the side wall 7 of the battery housing portion 4 engages with the fixing member 13. The state is released, and the battery 3 can be pulled out from the battery housing 4.

なお、バッテリー3の背面には、バッテリー収容部4の奥に配置されるコネクタに連結されるコネクタが取り付けられている。また、バッテリー3の背面には、バッテリー収容部4の中で、上下左右方向におけるバッテリー3の位置決めを行うための位置決めピンが取り付けられている。   A connector connected to a connector disposed at the back of the battery housing 4 is attached to the back surface of the battery 3. A positioning pin for positioning the battery 3 in the up / down / left / right directions in the battery housing 4 is attached to the back surface of the battery 3.

(バッテリー交換ロボットの概略構成)
図2に示すように、ロボット5は、バス2からの4個のバッテリー3のそれぞれの引抜きおよびバス2への4個のバッテリー3のそれぞれの差込みを行うバッテリー抜差機構17と、バッテリー抜差機構17を昇降させる昇降機構18と、上下方向を軸方向としてバッテリー抜差機構17および昇降機構18を回動させる回動機構19と、バッテリー抜差機構17、昇降機構18および回動機構19を左右方向へ移動させる水平移動機構20とを備えている。また、ロボット5は、検出用マーク8および検出用プレート9を検出するための検出機構21を備えている。
(Schematic configuration of battery replacement robot)
As shown in FIG. 2, the robot 5 includes a battery insertion / removal mechanism 17 for pulling out the four batteries 3 from the bus 2 and inserting the four batteries 3 into the bus 2, and a battery insertion / removal mechanism. An elevating mechanism 18 for elevating the mechanism 17, a rotating mechanism 19 for rotating the battery inserting / removing mechanism 17 and the elevating mechanism 18 about the vertical direction as an axial direction, a battery inserting / removing mechanism 17, the elevating mechanism 18, and the rotating mechanism 19 And a horizontal movement mechanism 20 for moving in the left-right direction. The robot 5 also includes a detection mechanism 21 for detecting the detection mark 8 and the detection plate 9.

バッテリー抜差機構17は、バッテリー3の引抜き時および差込み時にバッテリー3が搭載されるバッテリー搭載部22を有するバッテリー搭載機構23と、バッテリー3の引抜き時および差込み時にバッテリー3に係合してバッテリー搭載部22上でバッテリー3を移動させるバッテリー係合部24(図6参照)を有するバッテリー移動機構25とを備えている。バッテリー搭載部22およびバッテリー係合部24は、バス2に近づく方向およびバス2から離れる方向へ移動可能となっている。   The battery insertion / removal mechanism 17 includes a battery mounting mechanism 23 having a battery mounting portion 22 on which the battery 3 is mounted when the battery 3 is pulled out and inserted, and a battery mounting mechanism that is engaged with the battery 3 when the battery 3 is pulled out and inserted. And a battery moving mechanism 25 having a battery engaging portion 24 (see FIG. 6) for moving the battery 3 on the portion 22. The battery mounting portion 22 and the battery engaging portion 24 are movable in a direction approaching the bus 2 and a direction away from the bus 2.

また、バッテリー抜差機構17は、略四角筒状に形成された保持部材26に保持されている。保持部材26は、その下端側を構成する第1保持部材27と、その上端側を構成する第2保持部材28とを備えている。第1保持部材27は、上側が開口する角溝状に形成され、第2保持部材28は、下側が開口する角溝状に形成されている。保持部材26は、第1保持部材27と第2保持部材28とが上下方向で組み合わされて固定されることで、バッテリー搭載部22およびバッテリー係合部24の移動方向の両端が開口する略四角筒状に形成されている。   The battery insertion / removal mechanism 17 is held by a holding member 26 formed in a substantially rectangular tube shape. The holding member 26 includes a first holding member 27 constituting the lower end side thereof and a second holding member 28 constituting the upper end side thereof. The first holding member 27 is formed in a rectangular groove shape that opens on the upper side, and the second holding member 28 is formed in a rectangular groove shape that opens on the lower side. The holding member 26 is a substantially square in which both ends of the battery mounting portion 22 and the battery engaging portion 24 in the moving direction are opened by the first holding member 27 and the second holding member 28 being combined and fixed in the vertical direction. It is formed in a cylindrical shape.

(バッテリー搭載機構の構成)
図6は、図2に示すバッテリー抜差機構17および昇降機構18を正面から示す図である。図7は、図6のH−H方向からバッテリー抜差機構17および昇降機構18を示す図である。図8は、図6に示すバッテリー搭載機構23を正面から説明するための図である。図9は、図6に示すバッテリー搭載機構23を側面から説明するための図である。図10は、図6に示すバッテリー搭載機構23を上面から説明するための図である。図11は、図8に示すローラ32の拡大断面図である。
(Configuration of battery mounting mechanism)
FIG. 6 is a diagram showing the battery insertion / removal mechanism 17 and the lifting mechanism 18 shown in FIG. 2 from the front. FIG. 7 is a diagram showing the battery insertion / removal mechanism 17 and the lifting mechanism 18 from the HH direction in FIG. 6. FIG. 8 is a view for explaining the battery mounting mechanism 23 shown in FIG. 6 from the front. FIG. 9 is a view for explaining the battery mounting mechanism 23 shown in FIG. 6 from the side. FIG. 10 is a view for explaining the battery mounting mechanism 23 shown in FIG. 6 from above. FIG. 11 is an enlarged cross-sectional view of the roller 32 shown in FIG.

バッテリー搭載機構23は、上述のバッテリー搭載部22に加え、バス2に近づく方向およびバス2から離れる方向へバッテリー搭載部22を移動させる搭載部移動機構30を備えている。   In addition to the battery mounting portion 22 described above, the battery mounting mechanism 23 includes a mounting portion moving mechanism 30 that moves the battery mounting portion 22 in a direction approaching the bus 2 and a direction away from the bus 2.

バッテリー搭載部22は、上下方向に扁平した扁平なブロック状に形成されている。バッテリー搭載部22の上面には、バッテリー3の下面に当接する複数のローラ31、32が回転可能に取り付けられている。図10に示すように、複数のローラ31は、バッテリー搭載部22の移動方向に所定の間隔で配置され、複数のローラ32も、ローラ31と同様に、バッテリー搭載部22の移動方向に所定の間隔で配置されている。また、ローラ31とローラ32とは、バッテリー搭載部22の移動方向に直交する方向において、所定の間隔をあけた状態で配置されている。   The battery mounting portion 22 is formed in a flat block shape that is flat in the vertical direction. A plurality of rollers 31 and 32 that are in contact with the lower surface of the battery 3 are rotatably attached to the upper surface of the battery mounting portion 22. As shown in FIG. 10, the plurality of rollers 31 are arranged at predetermined intervals in the moving direction of the battery mounting portion 22, and the plurality of rollers 32 are also set in the moving direction of the battery mounting portion 22 in the same manner as the rollers 31. Arranged at intervals. In addition, the roller 31 and the roller 32 are arranged with a predetermined interval in a direction orthogonal to the moving direction of the battery mounting portion 22.

ローラ31は、フラットローラである。一方、ローラ32は、図11に示すように、内周側に向かって窪む溝部32aが外周面に形成された溝付きローラである。溝部32aは、バッテリー3の下面に形成される突起部12が係合可能となるように形成されており、バッテリー搭載部22の所定の位置にバッテリー3が搭載されると、溝部32aに突起部12が係合する。本形態では、溝部32aに突起部12が係合することで、バッテリー搭載部22の移動方向に直交する方向で、バッテリー搭載部22に対してバッテリー3が位置決めされる。   The roller 31 is a flat roller. On the other hand, as shown in FIG. 11, the roller 32 is a grooved roller in which a groove 32a that is recessed toward the inner peripheral side is formed on the outer peripheral surface. The groove 32a is formed so that the protrusion 12 formed on the lower surface of the battery 3 can be engaged, and when the battery 3 is mounted at a predetermined position of the battery mounting portion 22, the protrusion is formed on the groove 32a. 12 is engaged. In this embodiment, the protrusion 3 is engaged with the groove 32 a, whereby the battery 3 is positioned with respect to the battery mounting portion 22 in a direction orthogonal to the moving direction of the battery mounting portion 22.

搭載部移動機構30は、バッテリー搭載部22を移動させるための構成として、モータ33と、ボールネジ等のネジ部材34と、ネジ部材34に螺合するナット部材35とを備えている。また、搭載部移動機構30は、バッテリー搭載部22を案内するための構成として、直線状に形成されたガイドレール36と、ガイドレール36に係合するとともにガイドレール36に沿って相対移動可能なガイドブロック37とを備えている。   The mounting unit moving mechanism 30 includes a motor 33, a screw member 34 such as a ball screw, and a nut member 35 that is screwed into the screw member 34 as a configuration for moving the battery mounting unit 22. Further, the mounting unit moving mechanism 30 is configured to guide the battery mounting unit 22, and is linearly formed, and engages with the guide rail 36 and is relatively movable along the guide rail 36. A guide block 37 is provided.

モータ33は、バッテリー搭載部22の後端部の上面側に固定されている。ネジ部材34は、バッテリー搭載部22の下面側に回転可能に保持されている。モータ33とネジ部材34とは、プーリやベルト等を介して連結されている。ナット部材35は、第1保持部材27に固定されている。また、ガイドレール36は、バッテリー搭載部22の下面側に固定され、ガイドブロック37は、第1保持部材27に固定されている。そのため、本形態では、モータ33が回転すると、バッテリー搭載部22は、ガイドレール36およびガイドブロック37に案内されて、第1保持部材27に対して直線状に移動する。   The motor 33 is fixed to the upper surface side of the rear end portion of the battery mounting portion 22. The screw member 34 is rotatably held on the lower surface side of the battery mounting portion 22. The motor 33 and the screw member 34 are connected via a pulley, a belt, or the like. The nut member 35 is fixed to the first holding member 27. The guide rail 36 is fixed to the lower surface side of the battery mounting portion 22, and the guide block 37 is fixed to the first holding member 27. Therefore, in this embodiment, when the motor 33 rotates, the battery mounting portion 22 is guided by the guide rail 36 and the guide block 37 and moves linearly with respect to the first holding member 27.

(バッテリー移動機構の構成)
図12は、図6に示すバッテリー移動機構25を正面から説明するための図である。図13は、図6に示すバッテリー移動機構25を側面から説明するための図である。図14は、図13に示すバッテリー係合部24がバス2から離れる方向へ移動したときの状態を側面から説明するための図である。図15は、図13のJ部の拡大図である。図16は、図13のK部の拡大図である。図17は、図6に示すバッテリー移動機構25を上面から説明するための図である。図18(A)は、図17のM部の拡大図であり、図18(B)は、図17のN部の拡大図である。
(Configuration of battery moving mechanism)
FIG. 12 is a view for explaining the battery moving mechanism 25 shown in FIG. 6 from the front. FIG. 13 is a view for explaining the battery moving mechanism 25 shown in FIG. 6 from the side. FIG. 14 is a view for explaining the state when the battery engaging portion 24 shown in FIG. 13 moves away from the bus 2 from the side. FIG. 15 is an enlarged view of a portion J in FIG. FIG. 16 is an enlarged view of a portion K in FIG. FIG. 17 is a view for explaining the battery moving mechanism 25 shown in FIG. 6 from above. 18A is an enlarged view of an M portion in FIG. 17, and FIG. 18B is an enlarged view of an N portion in FIG.

バッテリー移動機構25は、上述のバッテリー係合部24に加え、バス2に近づく方向およびバス2から離れる方向へバッテリー係合部24を移動させる係合部移動機構39と、バッテリー係合部24を移動可能に保持するとともに第2保持部材28に移動可能に保持される移動保持部材40とを備えている。   In addition to the battery engaging portion 24 described above, the battery moving mechanism 25 includes an engaging portion moving mechanism 39 that moves the battery engaging portion 24 in a direction approaching the bus 2 and a direction away from the bus 2, and a battery engaging portion 24. And a movable holding member 40 that is held movably and held by the second holding member 28.

バッテリー係合部24は、バッテリー3の取手部11に係合する係合爪部41と、係合爪部41を上下動させるエアシリンダ42と、エアシリンダ42が取り付けられる基部43とを備えている。係合爪部41は、エアシリンダ42の可動側に固定され、エアシリンダ42の固定側は、基部43の先端面に固定されている。本形態では、バッテリー3に形成される2個の取手部11のそれぞれに係合爪部41が係合するように、2個の係合爪部41および2個のエアシリンダ42が基部43の先端面に所定の間隔をあけた状態で配置されている。   The battery engaging portion 24 includes an engaging claw portion 41 that engages with the handle portion 11 of the battery 3, an air cylinder 42 that moves the engaging claw portion 41 up and down, and a base portion 43 to which the air cylinder 42 is attached. Yes. The engaging claw portion 41 is fixed to the movable side of the air cylinder 42, and the fixed side of the air cylinder 42 is fixed to the distal end surface of the base portion 43. In this embodiment, the two engaging claws 41 and the two air cylinders 42 of the base 43 are arranged so that the engaging claws 41 are engaged with the two handles 11 formed on the battery 3. It arrange | positions in the state which opened the predetermined space | interval at the front end surface.

係合爪部41は、エアシリンダ42に固定される固定部41aと、取手部11に係合する爪部41bとを備えている。爪部41bは、取手部11の前端部分とバッテリー3の前面との間に上側から入って取手部11に係合する。爪部41bが取手部11に係合する際には、爪部41bが解除部材14を押して、バッテリー収容部4の側壁7に形成される係合孔と固定部材13との係合状態を解除する。そのため、爪部41bが取手部11に係合すると、バッテリー抜差機構17によるバッテリー3の引抜きや差込みが可能になる。   The engaging claw portion 41 includes a fixing portion 41 a that is fixed to the air cylinder 42 and a claw portion 41 b that engages with the handle portion 11. The claw portion 41 b enters from the upper side between the front end portion of the handle portion 11 and the front surface of the battery 3 and engages with the handle portion 11. When the claw portion 41 b engages with the handle portion 11, the claw portion 41 b pushes the release member 14 to release the engagement state between the engagement hole formed in the side wall 7 of the battery housing portion 4 and the fixing member 13. To do. Therefore, when the claw portion 41 b is engaged with the handle portion 11, the battery 3 can be pulled out and inserted by the battery pulling mechanism 17.

移動保持部材40は、バッテリー係合部24の移動方向に細長い長尺状に形成されている。また、移動保持部材40は、バッテリー係合部24の移動方向から見たときの形状が略H形状となるように形成されている。   The movement holding member 40 is formed in a long and narrow shape in the moving direction of the battery engaging portion 24. Further, the movement holding member 40 is formed so that the shape when viewed from the moving direction of the battery engaging portion 24 is substantially H-shaped.

係合部移動機構39は、バッテリー係合部24および移動保持部材40を移動させるための構成として、モータ44と、ボールネジ等のネジ部材45と、ネジ部材45に螺合するナット部材46と、プーリ47、48と、プーリ47、48に架け渡されるベルト49とを備えている。また、係合部移動機構39は、バッテリー係合部24および移動保持部材40を案内するための構成として、直線状に形成されたガイドレール50と、ガイドレール50に係合するとともにガイドレール50に沿って相対移動可能なガイドブロック51とを備え、バッテリー係合部24を案内するための構成として、直線状に形成されたガイドレール52と、ガイドレール52に係合するとともにガイドレール52に沿って相対移動可能なガイドブロック53とを備えている。   The engaging portion moving mechanism 39 includes a motor 44, a screw member 45 such as a ball screw, a nut member 46 that is screwed to the screw member 45, and a structure for moving the battery engaging portion 24 and the movement holding member 40. Pulleys 47 and 48 and a belt 49 spanning the pulleys 47 and 48 are provided. Further, the engaging portion moving mechanism 39 is configured to guide the battery engaging portion 24 and the movement holding member 40, and engages with the guide rail 50 formed in a straight line, the guide rail 50, and the guide rail 50. And a guide block 51 that is relatively movable along the guide rail 52. As a configuration for guiding the battery engaging portion 24, the guide rail 52 that is linearly formed, and the guide rail 52 that engages with the guide rail 52 and And a guide block 53 that is relatively movable along.

モータ44は、第2保持部材28の後端部の上面に固定されている。ネジ部材45は、第2保持部材28の上面部に回転可能に保持されている。モータ44とネジ部材45とは、プーリやベルト等を介して連結されている。ナット部材46は、移動保持部材40の後端部に固定されている。プーリ47は、移動保持部材40の後端部に回転可能に保持され、プーリ48は、移動保持部材40の前端部に回転可能に保持されている。   The motor 44 is fixed to the upper surface of the rear end portion of the second holding member 28. The screw member 45 is rotatably held on the upper surface portion of the second holding member 28. The motor 44 and the screw member 45 are connected via a pulley, a belt, or the like. The nut member 46 is fixed to the rear end portion of the movement holding member 40. The pulley 47 is rotatably held at the rear end portion of the movement holding member 40, and the pulley 48 is rotatably held at the front end portion of the movement holding member 40.

ベルト49は、ベルト固定部材54を介してバッテリー係合部24の基部43に固定されるとともに、ベルト固定部材55を介して第2保持部材28の上面部に固定されている。具体的には、第2保持部材28から移動保持部材40が突出して、図16に示すように、プーリ47の近傍にベルト固定部材55が配置されるときに、図15に示すように、プーリ48の近傍にベルト固定部材54が配置され、かつ、第2保持部材28の中に移動保持部材40が収まって、図14に示すように、プーリ48の近傍にベルト固定部材55が配置されるときに、プーリ47の近傍にベルト固定部材54が配置されるように、ベルト49は、ベルト固定部材54、55を介して基部43および第2保持部材28に固定されている。   The belt 49 is fixed to the base portion 43 of the battery engaging portion 24 via the belt fixing member 54 and is fixed to the upper surface portion of the second holding member 28 via the belt fixing member 55. Specifically, when the movable holding member 40 protrudes from the second holding member 28 and the belt fixing member 55 is disposed in the vicinity of the pulley 47 as shown in FIG. 16, the pulley as shown in FIG. The belt fixing member 54 is disposed in the vicinity of 48, and the movable holding member 40 is accommodated in the second holding member 28, and the belt fixing member 55 is disposed in the vicinity of the pulley 48 as shown in FIG. Sometimes, the belt 49 is fixed to the base 43 and the second holding member 28 via the belt fixing members 54 and 55 so that the belt fixing member 54 is disposed in the vicinity of the pulley 47.

ガイドレール50は、第2保持部材28の上面部に固定され、ガイドブロック51は、移動保持部材40の上面に固定されている。ガイドレール52は、移動保持部材40の下面に固定され、ガイドブロック53は、バッテリー係合部24の基部43の上端側に固定されている。   The guide rail 50 is fixed to the upper surface portion of the second holding member 28, and the guide block 51 is fixed to the upper surface of the moving holding member 40. The guide rail 52 is fixed to the lower surface of the movement holding member 40, and the guide block 53 is fixed to the upper end side of the base portion 43 of the battery engaging portion 24.

本形態では、モータ44が回転すると、ネジ部材45とナット部材46とによって、バッテリー係合部24とともに移動保持部材40がガイドレール50およびガイドブロック51に案内されて、第2保持部材28に対して直線状に移動する。また、モータ44が回転すると、プーリ47、48とベルト49とによって、バッテリー係合部24がガイドレール52およびガイドブロック53に案内されて、移動保持部材40に対して直線状に相対移動する。   In the present embodiment, when the motor 44 is rotated, the moving holding member 40 is guided to the guide rail 50 and the guide block 51 together with the battery engaging portion 24 by the screw member 45 and the nut member 46, so that the second holding member 28 is moved. Move in a straight line. When the motor 44 rotates, the battery engaging portion 24 is guided by the guide rail 52 and the guide block 53 by the pulleys 47 and 48 and the belt 49, and relatively moves linearly with respect to the movement holding member 40.

(昇降機構、第1連結機構および第2連結機構の構成)
昇降機構18は、図2、図6に示すように、バッテリー搭載部22およびバッテリー係合部24の移動方向と上下方向とに直交する方向(以下、この方向を「第1方向」とする。)の両端側のそれぞれに配置される第1昇降機構59および第2昇降機構60を備えている。第1昇降機構59は、第1連結機構61によって、第1保持部材27の第1方向の一端側に連結されている。第2昇降機構60は、第2連結機構62によって、第1保持部材27の第1方向の他端側に連結されている。第1昇降機構59および第2昇降機構60は、水平方向に対して保持部材26を傾けるために(すなわち、バッテリー搭載部22およびバッテリー係合部24の移動方向から見たときの第1方向に対して保持部材26を傾けるために)、個別に駆動可能となっている。また、保持部材26は、水平方向に対して傾斜可能となるように第1昇降機構59および第2昇降機構60に連結されている。
(Configuration of lifting mechanism, first coupling mechanism and second coupling mechanism)
As shown in FIGS. 2 and 6, the elevating mechanism 18 has a direction orthogonal to the moving direction of the battery mounting portion 22 and the battery engaging portion 24 and the vertical direction (hereinafter, this direction is referred to as a “first direction”). ) Are provided on the both ends of the first elevating mechanism 59 and the second elevating mechanism 60. The first elevating mechanism 59 is connected to one end side of the first holding member 27 in the first direction by the first connecting mechanism 61. The second elevating mechanism 60 is connected to the other end side of the first holding member 27 in the first direction by the second connecting mechanism 62. The first elevating mechanism 59 and the second elevating mechanism 60 are provided in order to incline the holding member 26 with respect to the horizontal direction (that is, in the first direction when viewed from the moving direction of the battery mounting portion 22 and the battery engaging portion 24). In order to tilt the holding member 26 with respect to it), it can be driven individually. The holding member 26 is connected to the first elevating mechanism 59 and the second elevating mechanism 60 so as to be inclined with respect to the horizontal direction.

第1昇降機構59および第2昇降機構60は、上下方向へ移動可能な昇降部材63と、昇降部材63を昇降可能に保持する柱状部材64と、昇降部材63を昇降させる昇降駆動機構65とを備えている。柱状部材64は、上下方向に細長い柱状に形成されている。図6に示すように、第1昇降機構59を構成する柱状部材64の上端と、第2昇降機構60を構成する柱状部材64の上端とは、連結部材66によって連結されており、2個の柱状部材64と連結部材66とによって、門型のフレームが構成されている。   The first elevating mechanism 59 and the second elevating mechanism 60 include an elevating member 63 that is movable in the vertical direction, a columnar member 64 that holds the elevating member 63 so as to be able to elevate, and an elevating drive mechanism 65 that elevates the elevating member 63. I have. The columnar member 64 is formed in a column shape elongated in the vertical direction. As shown in FIG. 6, the upper end of the columnar member 64 constituting the first elevating mechanism 59 and the upper end of the columnar member 64 constituting the second elevating mechanism 60 are connected by a connecting member 66, and two pieces The columnar member 64 and the connecting member 66 constitute a portal frame.

昇降駆動機構65は、図7に示すように、昇降部材63を昇降させるための構成として、モータ67と、ボールネジ等のネジ部材68と、ネジ部材68に螺合するナット部材69とを備えている。また、昇降駆動機構65は、図6に示すように、昇降部材63を案内するための構成として、直線状に形成されたガイドレール70と、ガイドレール70に係合するとともにガイドレール70に沿って相対移動可能なガイドブロック71とを備えている。   As shown in FIG. 7, the elevating drive mechanism 65 includes a motor 67, a screw member 68 such as a ball screw, and a nut member 69 screwed to the screw member 68 as a configuration for elevating the elevating member 63. Yes. As shown in FIG. 6, the elevating drive mechanism 65 is configured to guide the elevating member 63, and engages with the guide rail 70 formed in a straight line, along the guide rail 70 and along the guide rail 70. The guide block 71 is relatively movable.

モータ67は、柱状部材64の上端側に固定されている。ネジ部材68は、柱状部材64に回転可能に保持されている。モータ67とネジ部材68とは、カップリング72を介して連結されている。ナット部材69は、昇降部材63に固定されている。ガイドレール70は、柱状部材64の側面に固定されている。ガイドブロック71は、昇降部材63に固定されている。そのため、本形態では、モータ67が回転すると、昇降部材63は、ガイドレール70およびガイドブロック71に案内されて、柱状部材64に対して上下動する。   The motor 67 is fixed to the upper end side of the columnar member 64. The screw member 68 is rotatably held by the columnar member 64. The motor 67 and the screw member 68 are connected via a coupling 72. The nut member 69 is fixed to the elevating member 63. The guide rail 70 is fixed to the side surface of the columnar member 64. The guide block 71 is fixed to the elevating member 63. Therefore, in this embodiment, when the motor 67 rotates, the elevating member 63 is guided by the guide rail 70 and the guide block 71 and moves up and down with respect to the columnar member 64.

第1連結機構61は、第1昇降機構59の昇降部材63に対する保持部材26の相対回動が可能となるように、保持部材26と昇降部材63とを連結している。また、第2連結機構62は、第2昇降機構60の昇降部材63に対する保持部材26の相対回動と第1方向への相対移動とが可能となるように、保持部材26と昇降部材63とを連結している。本形態では、第1昇降機構59の昇降部材63の移動量と第2昇降機構60の昇降部材63の移動量とが等しくなるようにモータ67が回転すると、保持部材26が水平方向と平行な状態を保ったまま昇降する。一方、第1昇降機構59のモータ67または第2昇降機構60のモータ67の一方のみが回転すると、水平方向に対して保持部材26が傾く。また、第1昇降機構59の昇降部材63の移動量と第2昇降機構60の昇降部材63の移動量とが異なるようにモータ67が回転すると、保持部材26が水平方向に対して傾きながら昇降する。   The first connecting mechanism 61 connects the holding member 26 and the elevating member 63 so that the holding member 26 can be rotated relative to the elevating member 63 of the first elevating mechanism 59. Further, the second connecting mechanism 62 is configured so that the holding member 26 and the elevating member 63 are capable of relative rotation of the holding member 26 with respect to the elevating member 63 of the second elevating mechanism 60 and relative movement in the first direction. Are connected. In this embodiment, when the motor 67 rotates so that the moving amount of the lifting member 63 of the first lifting mechanism 59 is equal to the moving amount of the lifting member 63 of the second lifting mechanism 60, the holding member 26 is parallel to the horizontal direction. Go up and down while maintaining the state. On the other hand, when only one of the motor 67 of the first lifting mechanism 59 or the motor 67 of the second lifting mechanism 60 rotates, the holding member 26 tilts with respect to the horizontal direction. Further, when the motor 67 rotates so that the moving amount of the lifting member 63 of the first lifting mechanism 59 and the moving amount of the lifting member 63 of the second lifting mechanism 60 are different, the holding member 26 is lifted while being inclined with respect to the horizontal direction. To do.

(回動機構および水平移動機構の構成)
回動機構19は、図2に示すように、バッテリー抜差機構17および昇降機構18が搭載されるとともに回動可能な回動部材85と、回動部材85を回動させる回動駆動機構86とを備えている。水平移動機構20は、図2に示すように、バッテリー抜差機構17、昇降機構18および回動機構19が搭載されるとともに左右方向へ移動可能なスライド部材87と、スライド部材87を移動させる水平駆動機構88とを備えている。
(Configuration of rotation mechanism and horizontal movement mechanism)
As shown in FIG. 2, the rotation mechanism 19 includes a battery insertion / removal mechanism 17 and an elevating mechanism 18, and a rotation member 85 that can rotate, and a rotation drive mechanism 86 that rotates the rotation member 85. And. As shown in FIG. 2, the horizontal movement mechanism 20 is equipped with a battery insertion / removal mechanism 17, an elevating mechanism 18, and a rotation mechanism 19, and a slide member 87 that is movable in the left-right direction, and a horizontal that moves the slide member 87. And a drive mechanism 88.

回動部材85は、略円板状に形成されている。スライド部材87は、左右方向を長手方向とする略長方形の板状に形成されている。スライド部材87の左右方向の幅は、回動部材85の直径よりも大きくなっており、スライド部材87の前後方向の幅は、回動部材85の直径よりも小さくなっている。   The rotating member 85 is formed in a substantially disk shape. The slide member 87 is formed in a substantially rectangular plate shape whose longitudinal direction is the left-right direction. The width of the slide member 87 in the left-right direction is larger than the diameter of the rotating member 85, and the width of the slide member 87 in the front-rear direction is smaller than the diameter of the rotating member 85.

回動部材85は、スライド部材87の上側に配置されている。この回動部材85は、その曲率中心を中心にして回動可能となっている。回動部材85の上面には、2本の柱状部材64の下端が固定されている。具体的には、バッテリー搭載部22およびバッテリー係合部24の移動方向に直交する第1方向における回動部材85の上面の両端側のそれぞれに柱状部材64の下端が固定されている。   The rotating member 85 is disposed on the upper side of the slide member 87. The turning member 85 can turn around the center of curvature. The lower ends of the two columnar members 64 are fixed to the upper surface of the rotating member 85. Specifically, the lower ends of the columnar members 64 are fixed to both ends of the upper surface of the rotating member 85 in the first direction orthogonal to the moving direction of the battery mounting portion 22 and the battery engaging portion 24.

回動駆動機構86は、回動部材85を回動させるための構成として、モータ、プーリおよびベルト等を備えている。また、回動駆動機構86は、回動部材85を回動方向へ案内するための構成として、ガイドレールと、ガイドレールに係合するとともにガイドレールに沿って相対移動可能な複数のガイドブロックとを備えている。ガイドレールは、円環状に形成されており、スライド部材87の上面に固定されている。複数のガイドブロックは、回動部材85の下面側に固定されており、回動部材85の曲率中心を中心とする円環状に配置されている。モータの出力軸に固定されるプーリおよび回動部材85の外周面等にはベルトが架け渡されており、モータが回転すると、回動部材85は、ガイドレールおよびガイドブロックに案内されてスライド部材87に対して回動する。   The rotation drive mechanism 86 includes a motor, a pulley, a belt, and the like as a configuration for rotating the rotation member 85. Further, the rotation drive mechanism 86 is configured to guide the rotation member 85 in the rotation direction, and a guide rail and a plurality of guide blocks that engage with the guide rail and are relatively movable along the guide rail. It has. The guide rail is formed in an annular shape and is fixed to the upper surface of the slide member 87. The plurality of guide blocks are fixed to the lower surface side of the rotating member 85, and are arranged in an annular shape centering on the center of curvature of the rotating member 85. A belt is stretched over the pulley fixed to the output shaft of the motor and the outer peripheral surface of the rotating member 85, and when the motor rotates, the rotating member 85 is guided by the guide rail and the guide block to slide. It rotates with respect to 87.

水平駆動機構88は、スライド部材87を移動させるための構成として、モータ、プーリおよびベルト等を備えている。また、水平駆動機構88は、スライド部材87を左右方向へ案内するための構成として、直線状に形成されたガイドレールと、ガイドレールに係合するとともにガイドレールに沿って相対移動可能な複数のガイドブロックとを備えている。ガイドレールは、スライド部材87の下側に配置されている。ガイドブロックは、スライド部材87の下面に固定されている。ベルトの一端は、ガイドレールの左端側に固定され、ベルトの他端は、ガイドレールの右端側に固定されている。また、ベルトは、モータの出力軸に固定されるプーリ等に架け渡されており、モータが回転すると、ガイドレールおよびガイドブロックに案内されてスライド部材87が左右方向へ直線状に移動する。   The horizontal drive mechanism 88 includes a motor, a pulley, a belt, and the like as a configuration for moving the slide member 87. Further, the horizontal drive mechanism 88 is configured to guide the slide member 87 in the left-right direction, and a plurality of guide rails that are linearly formed and a plurality of guide rails that are engaged with the guide rails and are relatively movable along the guide rails. And a guide block. The guide rail is disposed below the slide member 87. The guide block is fixed to the lower surface of the slide member 87. One end of the belt is fixed to the left end side of the guide rail, and the other end of the belt is fixed to the right end side of the guide rail. The belt is stretched around a pulley or the like fixed to the output shaft of the motor. When the motor rotates, the slide member 87 is linearly moved in the left-right direction by being guided by the guide rail and the guide block.

(検出機構の構成、バスの位置検出動作およびバッテリーの位置検出動作)
図19は、図10に示す検出機構21によるバス2の位置の検出時の状態を上面から示す図である。図20は、図10に示す検出機構21によるバス2の位置の検出方法を説明するための概略図である。図21は、図10に示す検出機構21によるバッテリー3の位置の検出時の状態を上面から示す図である。図22は、図10に示す検出機構21によるバッテリー3の位置の検出方法を説明するための図である。
(Configuration of detection mechanism, bus position detection operation and battery position detection operation)
FIG. 19 is a diagram showing the state when the position of the bus 2 is detected by the detection mechanism 21 shown in FIG. FIG. 20 is a schematic diagram for explaining a method of detecting the position of the bus 2 by the detection mechanism 21 shown in FIG. FIG. 21 is a diagram showing a state when the position of the battery 3 is detected by the detection mechanism 21 shown in FIG. 10 from above. FIG. 22 is a diagram for explaining a method of detecting the position of the battery 3 by the detection mechanism 21 shown in FIG.

検出機構21は、レーザ光を射出する発光部と、この発光部から射出されバス2の側面2aやバッテリー置き台6の前面等で反射されたレーザ光を受光する受光部とを備えるレーザセンサである。この検出機構21は、図10に示すように、バッテリー搭載部22の前端側の上面に取り付けられている。また、検出機構21は、発光部と受光部とが水平方向で隣り合うように、あるいは、発光部と受光部とが上下方向で隣り合うように、バッテリー搭載部22に取り付けられている。本形態では、4個のバッテリー置き台6のそれぞれに形成される一対の(2個の)検出用マーク8に対応するように、2個の検出機構21がバッテリー搭載部22に取り付けられている。具体的には、バッテリー搭載部22およびバッテリー係合部24の移動方向に直交する第1方向におけるバッテリー搭載部22の両端側の上面に検出機構21が固定されている。また、一対の検出用マーク8の間隔と同じ間隔で、2個の検出機構21がバッテリー搭載部22に固定されている。   The detection mechanism 21 is a laser sensor that includes a light emitting unit that emits laser light, and a light receiving unit that receives the laser light emitted from the light emitting unit and reflected by the side surface 2a of the bus 2, the front surface of the battery mount 6, and the like. is there. As shown in FIG. 10, the detection mechanism 21 is attached to the upper surface on the front end side of the battery mounting portion 22. The detection mechanism 21 is attached to the battery mounting portion 22 such that the light emitting portion and the light receiving portion are adjacent in the horizontal direction, or the light emitting portion and the light receiving portion are adjacent in the vertical direction. In this embodiment, two detection mechanisms 21 are attached to the battery mounting portion 22 so as to correspond to a pair of (two) detection marks 8 formed on each of the four battery mounts 6. . Specifically, the detection mechanism 21 is fixed to the upper surfaces of both ends of the battery mounting portion 22 in the first direction orthogonal to the moving direction of the battery mounting portion 22 and the battery engaging portion 24. Two detection mechanisms 21 are fixed to the battery mounting portion 22 at the same interval as the interval between the pair of detection marks 8.

検出機構21は、発光部から射出されたレーザ光を反射する反射物が所定の測定レンジ内にあるとオンの状態になり、レーザ光を反射する反射物が測定レンジ内にないとオフの状態になる。また、検出機構21では、検出機構21がオンの状態のときに、検出機構21と反射物との距離を検出することが可能となっている。   The detection mechanism 21 is turned on when a reflector that reflects the laser light emitted from the light emitting unit is within a predetermined measurement range, and is turned off when the reflector that reflects the laser light is not within the measurement range. become. The detection mechanism 21 can detect the distance between the detection mechanism 21 and the reflecting object when the detection mechanism 21 is on.

検出機構21によるバス2の位置の検出は、たとえば、以下のように行われる。すなわち、バッテリー3が交換されるバス2が所定の停止位置に停止したときには、たとえば、バッテリー抜差機構17は、左右方向において、検出用プレート9が配置される位置で待機している。また、このときには、図19の実線で示すように、バッテリー搭載部22の前面がバス2の側面2aと向き合うとともに、バッテリー搭載部22は、バス2から離れる方向に後退している。   The detection of the position of the bus 2 by the detection mechanism 21 is performed as follows, for example. That is, when the bus 2 in which the battery 3 is replaced stops at a predetermined stop position, for example, the battery insertion / removal mechanism 17 stands by at a position where the detection plate 9 is disposed in the left-right direction. At this time, as indicated by a solid line in FIG. 19, the front surface of the battery mounting portion 22 faces the side surface 2 a of the bus 2, and the battery mounting portion 22 is retracted away from the bus 2.

この状態から、図19の二点鎖線で示すように、検出機構21の発光部から射出され検出用プレート9で反射されたレーザ光を受光した検出機構21がオンの状態となるまで、バッテリー搭載部22がバス2に向かって前進する。その後、図20(A)の二点鎖線で示すように、上下方向において所定の位置にあるバッテリー搭載部22を、図20(A)の破線で示すように上方向へ移動させて、検出機構21によって検出用プレート9の上端の概略位置を検出する。その後、バッテリー搭載部22を、図20(A)の実線および図20(B)の破線で示すように、左右方向における検出用プレート9の両端の位置を検出するための高さまで下方向へ移動させる。   From this state, as shown by a two-dot chain line in FIG. 19, the battery is mounted until the detection mechanism 21 that receives the laser light emitted from the light emitting portion of the detection mechanism 21 and reflected by the detection plate 9 is turned on. Part 22 advances toward bus 2. Thereafter, as shown by a two-dot chain line in FIG. 20A, the battery mounting portion 22 at a predetermined position in the vertical direction is moved upward as shown by a broken line in FIG. The approximate position of the upper end of the detection plate 9 is detected by 21. Thereafter, as shown by the solid line in FIG. 20A and the broken line in FIG. 20B, the battery mounting portion 22 is moved downward to a height for detecting the positions of both ends of the detection plate 9 in the left-right direction. Let

その後、図20(B)の実線および図20(C)の破線で示すように、バッテリー搭載部22を左右方向の一方へ移動させて、検出機構21によって左右方向における検出用プレート9の一端の概略位置を検出する。その後、バッテリー搭載部22を、図20(C)の実線および図20(D)の二点鎖線で示すように左右方向の他方へ移動させて、検出機構21によって左右方向における検出用プレート9の両端の位置を検出する。   Thereafter, as indicated by the solid line in FIG. 20B and the broken line in FIG. The approximate position is detected. Thereafter, the battery mounting portion 22 is moved to the other in the left-right direction as indicated by the solid line in FIG. 20C and the two-dot chain line in FIG. 20D, and the detection mechanism 21 moves the detection plate 9 in the left-right direction. Detect the position of both ends.

その後、バッテリー搭載部22を、図20(D)の破線で示すように、検出機構21によって左右方向における検出用プレート9の一端を検出した位置から左右方向の他方へ所定の距離だけ離れた位置まで移動させてから、図20(D)の実線および図20(E)の二点鎖線で示すように上方向へ移動させて、検出機構21によって検出用プレート9の上端を検出する。また、その後、バッテリー搭載部22を、図20(E)の破線で示すように、検出機構21が左右方向における検出用プレート9の他端を検出した位置から左右方向の他方へ所定の距離だけ離れた位置まで、かつ、下方向に移動させてから、図20(E)の実線で示すように上方向へ移動させて、検出機構21によって検出用プレート9の上端を検出する。   Thereafter, as shown by the broken line in FIG. 20D, the battery mounting portion 22 is located at a predetermined distance from the position where one end of the detection plate 9 in the left-right direction is detected by the detection mechanism 21 to the other in the left-right direction. Then, the upper end of the detection plate 9 is detected by the detection mechanism 21 as shown by the solid line in FIG. 20D and the two-dot chain line in FIG. After that, as shown by the broken line in FIG. 20E, the battery mounting portion 22 is moved a predetermined distance from the position where the detection mechanism 21 detects the other end of the detection plate 9 in the left-right direction to the other in the left-right direction. After moving to a distant position and downward, it is moved upward as indicated by the solid line in FIG. 20E and the upper end of the detection plate 9 is detected by the detection mechanism 21.

以上のようにバッテリー搭載部22を移動させることで、検出機構21によって、前後方向、左右方向および上下方向における検出用プレート9の位置を検出する。また、検出機構21によって、前後方向、左右方向および上下方向における検出用プレート9の位置を検出することで、バス2の位置を検出する。また、以上のようにバッテリー搭載部22を移動させることで、検出機構21によって、前後方向から見たときの左右方向に対する検出用プレート9の傾き等を検出することも可能である。すなわち、以上のようにバッテリー搭載部22を移動させることで、検出機構21によって、前後方向から見たときの左右方向に対するバス2の傾き等を検出することも可能である。   By moving the battery mounting portion 22 as described above, the detection mechanism 21 detects the position of the detection plate 9 in the front-rear direction, the left-right direction, and the up-down direction. Further, the position of the bus 2 is detected by detecting the position of the detection plate 9 in the front-rear direction, the left-right direction, and the vertical direction by the detection mechanism 21. Further, by moving the battery mounting portion 22 as described above, the detection mechanism 21 can detect the inclination of the detection plate 9 with respect to the left-right direction when viewed from the front-rear direction. That is, by moving the battery mounting portion 22 as described above, the detection mechanism 21 can detect the inclination of the bus 2 with respect to the left-right direction when viewed from the front-rear direction.

検出機構21によるバス2の位置の検出後には、たとえば、以下のように、検出機構21によるバッテリー3の位置の検出が行われる。すなわち、まず、図21(A)に示すように、交換されるバッテリー3が搭載されるバッテリー置き台6の一対の検出用マーク8のそれぞれと、2個の検出機構21のそれぞれとが向き合うように、バッテリー搭載部22を左右方向へ移動させる。   After the detection mechanism 21 detects the position of the bus 2, for example, the detection mechanism 21 detects the position of the battery 3 as described below. That is, first, as shown in FIG. 21A, each of the pair of detection marks 8 of the battery mount 6 on which the battery 3 to be replaced is mounted and each of the two detection mechanisms 21 face each other. Next, the battery mounting portion 22 is moved in the left-right direction.

その後、検出機構21の発光部から射出され検出用マーク8で反射されたレーザ光を受光した検出機構21がオンの状態となるまで、バッテリー搭載部22をバッテリー置き台6に向かって前進させる。その後、図21(B)、(C)および図22(A)、(B)に示すように、検出機構21の発光部からのレーザ光が左右方向で検出用マーク8を横切るように、バッテリー搭載部22を左右方向へ移動させる。より具体的には、2個の検出機構21のそれぞれの発光部からのレーザ光が左右方向で2個の検出用マーク8のそれぞれを横切るように、バッテリー搭載部22を左右方向へ移動させる。   Thereafter, the battery mounting portion 22 is advanced toward the battery mount 6 until the detection mechanism 21 that has received the laser light emitted from the light emitting portion of the detection mechanism 21 and reflected by the detection mark 8 is turned on. Thereafter, as shown in FIGS. 21 (B), (C) and FIGS. 22 (A), (B), the battery so that the laser light from the light emitting portion of the detection mechanism 21 crosses the detection mark 8 in the left-right direction. The mounting portion 22 is moved in the left-right direction. More specifically, the battery mounting portion 22 is moved in the left-right direction so that the laser beams from the respective light-emitting portions of the two detection mechanisms 21 traverse each of the two detection marks 8 in the left-right direction.

検出機構21の発光部からのレーザ光が左右方向で検出用マーク8を横切るように、バッテリー搭載部22を左右方向へ移動させると、検出機構21によって、検出用マーク8の検出される部分(すなわち、レーザ光を反射する部分(図22(C)の破線部分)。以下、「被検出部分8a」とする。)の幅を検出することが可能である。本形態の検出用マーク8は、上下方向でその幅が変化する略三角形状に形成されているため、検出用マーク8の被検出部分8aの幅を検出することで、検出用マーク8の高さを検出することが可能であり、検出用マーク8の高さを検出することで、検出用マーク8が形成されるバッテリー置き台6の高さを検出することが可能である。本形態では、検出機構21で検出用マーク8の被検出部分8aの幅を検出することで、バッテリー置き台6の高さが検出され、バッテリー置き台6の高さが検出されることで、バッテリー置き台6に位置決めされて搭載されるバッテリー3の高さが検出される。   When the battery mounting portion 22 is moved in the left-right direction so that the laser light from the light-emitting portion of the detection mechanism 21 crosses the detection mark 8 in the left-right direction, the detection mechanism 8 detects a portion of the detection mark 8 ( That is, it is possible to detect the width of the portion that reflects the laser light (the broken line portion in FIG. 22C), hereinafter referred to as “detected portion 8a”. Since the detection mark 8 of this embodiment is formed in a substantially triangular shape whose width changes in the vertical direction, detecting the width of the detected portion 8a of the detection mark 8 increases the height of the detection mark 8. It is possible to detect the height of the battery holder 6 on which the detection mark 8 is formed by detecting the height of the detection mark 8. In this embodiment, the detection mechanism 21 detects the width of the detected portion 8a of the detection mark 8 to detect the height of the battery cradle 6 and the height of the battery cradle 6 is detected. The height of the battery 3 mounted on the battery stand 6 is detected.

また、検出機構21の発光部からのレーザ光が左右方向で検出用マーク8を横切るようにバッテリー搭載部22を移動させて、検出機構21で検出用マーク8を検出することで、検出用マーク8の被検出部分8aの左右方向の中心位置を検出することが可能である。本形態では、たとえば、この中心位置に基づいて、左右方向におけるバッテリー置き台6の位置が検出され、左右方向におけるバッテリー置き台6の位置が検出されることで、バッテリー置き台6に位置決めされて搭載されるバッテリー3の左右方向における位置が検出される。   Further, the detection mark 8 is detected by moving the battery mounting portion 22 so that the laser light from the light emitting portion of the detection mechanism 21 traverses the detection mark 8 in the left-right direction, and detecting the detection mark 8 by the detection mechanism 21. It is possible to detect the center position in the left-right direction of the eight detected portions 8a. In this embodiment, for example, the position of the battery cradle 6 in the left-right direction is detected based on this center position, and the position of the battery cradle 6 in the left-right direction is detected, so that the battery cradle 6 is positioned. The position of the mounted battery 3 in the left-right direction is detected.

また、検出用マーク8の被検出部分8aの左右方向の中心位置と検出機構21との距離を検出機構21で検出することが可能であり、本形態では、たとえば、この中心位置と検出機構21との距離に基づいて、前後方向におけるバッテリー置き台6の位置が検出され、前後方向におけるバッテリー置き台6の位置が検出されることで、バッテリー置き台6に位置決めされて搭載されるバッテリー3の前後方向における位置が検出される。   Further, the distance between the center position in the left-right direction of the detected portion 8a of the detection mark 8 and the detection mechanism 21 can be detected by the detection mechanism 21. In this embodiment, for example, the center position and the detection mechanism 21 are detected. The position of the battery cradle 6 in the front-rear direction is detected based on the distance between and the position of the battery cradle 6 in the front-rear direction, thereby detecting the position of the battery 3 that is positioned and mounted on the battery cradle 6. A position in the front-rear direction is detected.

また、2個の検出機構21のうちの一方の検出機構21で検出されたバッテリー置き台6の高さと、他方の検出機構21で検出されたバッテリー置き台6の高さとから、前後方向から見たときの左右方向に対するバッテリー置き台6の傾きが検出される。また、前後方向から見たときの左右方向に対するバッテリー置き台6の傾きが検出されることで、前後方向から見たときの左右方向に対するバッテリー3の傾きが検出される。   Further, the height of the battery cradle 6 detected by one of the two detection mechanisms 21 and the height of the battery cradle 6 detected by the other detection mechanism 21 are viewed in the front-rear direction. The inclination of the battery mount 6 with respect to the left-right direction is detected. Further, by detecting the inclination of the battery stand 6 with respect to the left-right direction when viewed from the front-rear direction, the inclination of the battery 3 with respect to the left-right direction when viewed from the front-rear direction is detected.

また、2個の検出機構21のうちの一方の検出機構21で検出された検出機構21と検出用マーク8との距離と、他方の検出機構21で検出された検出機構21と検出用マーク8との距離とから、上下方向から見たときの左右方向に対するバッテリー置き台6の傾きが検出される。また、上下方向から見たときの左右方向に対するバッテリー置き台6の傾きが検出されることで、上下方向から見たときの左右方向に対するバッテリー3の傾きが検出される。   Also, the distance between the detection mechanism 21 detected by one of the two detection mechanisms 21 and the detection mark 8, and the detection mechanism 21 detected by the other detection mechanism 21 and the detection mark 8. The inclination of the battery mount 6 with respect to the left-right direction when viewed from the up-down direction is detected. Further, by detecting the inclination of the battery pedestal 6 with respect to the left-right direction when viewed from the vertical direction, the inclination of the battery 3 with respect to the left-right direction when viewed from the vertical direction is detected.

前後左右方向におけるバッテリー3の位置、バッテリー3の高さ、前後方向から見たときの左右方向に対するバッテリー3の傾き、および、上下方向から見たときの左右方向に対するバッテリー3の傾きが検出されると、バッテリー3の下面の突起部12とバッテリー搭載部22のローラ32の溝部32aとが左右方向で略一致し、バッテリー3の下面と、ローラ31、32の上面とが略一致するとともに、前後方向から見たときの左右方向に対するバッテリー3の傾きとバッテリー抜差機構17の傾きとが略一致し、かつ、上下方向から見たときの左右方向に対するバッテリー3の傾きとバッテリー抜差機構17の傾きとが略一致するように、ロボット5によるバッテリー3の交換動作時に、バッテリー抜差機構17の左右方向の位置、高さおよび傾きが調整される。   The position of the battery 3 in the front-rear and left-right directions, the height of the battery 3, the inclination of the battery 3 with respect to the left-right direction when viewed from the front-rear direction, and the inclination of the battery 3 with respect to the left-right direction when viewed from the up-down direction are detected. And the protrusion 12 on the lower surface of the battery 3 and the groove 32a of the roller 32 of the battery mounting portion 22 substantially coincide with each other in the left-right direction, and the lower surface of the battery 3 and the upper surfaces of the rollers 31 and 32 substantially coincide with each other. The inclination of the battery 3 with respect to the left and right direction when viewed from the direction and the inclination of the battery insertion and removal mechanism 17 substantially coincide with each other, and the inclination of the battery 3 with respect to the left and right direction when viewed from the top and bottom The position of the battery insertion / removal mechanism 17 in the left-right direction and the height when the battery 3 is replaced by the robot 5 so that the inclination substantially coincides. And tilt is adjusted.

具体的には、水平移動機構20によってバッテリー抜差機構17の左右方向の位置が調整され、昇降機構18によって、バッテリー抜差機構17の高さが調整され、回動機構19によって、上下方向から見たときの左右方向に対するバッテリー抜差機構17の傾きが調整される。また、第1昇降機構59または第2昇降機構60の一方を駆動することで、あるいは、第1昇降機構59の駆動量と第2昇降機構60の駆動量とを変えることで、前後方向から見たときの左右方向に対するバッテリー抜差機構17の傾きが調整される。   Specifically, the horizontal position of the battery insertion / removal mechanism 17 is adjusted by the horizontal movement mechanism 20, the height of the battery insertion / removal mechanism 17 is adjusted by the elevating mechanism 18, and the vertical direction is adjusted by the rotation mechanism 19. The inclination of the battery insertion / removal mechanism 17 with respect to the left / right direction when viewed is adjusted. Further, by driving one of the first elevating mechanism 59 and the second elevating mechanism 60, or by changing the drive amount of the first elevating mechanism 59 and the drive amount of the second elevating mechanism 60, the front and rear directions can be seen. The inclination of the battery insertion / removal mechanism 17 with respect to the left / right direction is adjusted.

(バッテリー交換ロボットによるバッテリー交換動作の概略)
図23は、図2に示すバッテリー交換ロボット5のバッテリー3の交換動作の概略フローを示すフローチャートである。図24は、図2に示すバッテリー交換ロボット5によるバス2からのバッテリー3の引抜き動作を説明するための図である。図25は、図2に示すバッテリー交換ロボット5によるバス2へのバッテリー3の差込み動作を説明するための図である。
(Outline of battery replacement operation by battery replacement robot)
FIG. 23 is a flowchart showing a schematic flow of the replacement operation of the battery 3 of the battery replacement robot 5 shown in FIG. FIG. 24 is a view for explaining the operation of pulling out the battery 3 from the bus 2 by the battery exchange robot 5 shown in FIG. FIG. 25 is a diagram for explaining the operation of inserting the battery 3 into the bus 2 by the battery exchange robot 5 shown in FIG.

バッテリー交換システム1では、バッテリー3が交換されるバス2が所定の停止位置に停止すると、まず、上述の手順でバス2の位置が検出される(ステップS1)。その後、4個のバッテリー3のうちの交換されるバッテリー3のバス2からの引抜き動作が行われる(ステップS2)。ステップS2では、具体的には、交換されるバッテリー3の位置(より具体的には、交換されるバッテリー3が搭載されるバッテリー置き台6に形成される検出用マーク8の位置)が上述の手順で検出され(ステップS21)、その後、ロボット5によってバス2からバッテリー3が引き抜かれ(ステップS22)、その後、引き抜かれたバッテリー3がバッファステーションへ収容される(ステップS23)。   In the battery exchange system 1, when the bus 2 whose battery 3 is to be exchanged stops at a predetermined stop position, the position of the bus 2 is first detected by the above-described procedure (step S1). Thereafter, the operation of pulling out the battery 3 to be replaced from the bus 2 out of the four batteries 3 is performed (step S2). In step S2, specifically, the position of the battery 3 to be replaced (more specifically, the position of the detection mark 8 formed on the battery mount 6 on which the battery 3 to be replaced is mounted) is described above. The battery 3 is extracted from the bus 2 by the robot 5 (step S22), and then the extracted battery 3 is accommodated in the buffer station (step S23).

ステップS1、S2においては、まず、ホームポジションにあるバッテリー搭載部22およびバッテリー係合部24(図24(A)参照)が、バス2に近づく方向へ移動する。具体的には、図24(B)に示すように、バッテリー置き台6からバッテリー搭載部22へのバッテリー3の載り移りが可能な位置までバッテリー搭載部22が移動するとともに、バッテリー3の取手部11に係合爪部41が係合可能な位置までバッテリー係合部24が移動する。   In steps S <b> 1 and S <b> 2, first, the battery mounting portion 22 and the battery engaging portion 24 (see FIG. 24A) at the home position move in a direction approaching the bus 2. Specifically, as shown in FIG. 24B, the battery mounting portion 22 moves from the battery mount 6 to a position where the battery 3 can be transferred to the battery mounting portion 22, and the handle portion of the battery 3 is moved. 11, the battery engaging portion 24 moves to a position where the engaging claw portion 41 can be engaged.

本形態では、ホームポジションにあるバッテリー搭載部22およびバッテリー係合部24が図24(B)に示す位置まで移動する前に、上述の手順でバッテリー3の位置が検出される。すなわち、検出機構21の発光部から射出され検出用マーク8で反射されたレーザ光を受光した検出機構21がオンの状態となるまで、バッテリー搭載部22がバッテリー置き台6に向かって前進するとともに、バッテリー搭載部22が左右方向へ移動して(すなわち、ロボット5が左右方向へ移動して)、バッテリー3の位置が検出される。なお、以後の動作では、バッテリー3の位置検出の結果に基づいて、バッテリー搭載部22およびバッテリー係合部24の移動量等が調整される。   In this embodiment, the position of the battery 3 is detected by the above-described procedure before the battery mounting portion 22 and the battery engaging portion 24 at the home position move to the position shown in FIG. That is, the battery mounting portion 22 advances toward the battery mount 6 until the detection mechanism 21 that has received the laser light emitted from the light emitting portion of the detection mechanism 21 and reflected by the detection mark 8 is turned on. Then, the battery mounting portion 22 moves in the left-right direction (that is, the robot 5 moves in the left-right direction), and the position of the battery 3 is detected. In the subsequent operation, the movement amounts of the battery mounting portion 22 and the battery engaging portion 24 are adjusted based on the result of the position detection of the battery 3.

また、ステップS2においては、図24(B)に示す状態から係合爪部41が下降して取手部11に係合する。その後、図24(C)に示すように、バッテリー係合部24がバス2から離れる方向へ移動して、バッテリー置き台6からバッテリー搭載部22へバッテリー3が載り移り始める。バッテリー係合部24が所定量移動して、図24(D)に示すように、バッテリー3がバッテリー搭載部22に完全に搭載されると、その後、バッテリー搭載部22およびバッテリー係合部24が同期しながら、図24(E)に示すように、バス2から離れる方向へ移動して、バス2からのバッテリー3の引抜きが完了する。バス2からのバッテリー3の引抜きが完了すると、ロボット5は、180°回動して、バッファステーションにバッテリー3を収容する。   In step S2, the engaging claw portion 41 descends from the state shown in FIG. 24 (B) and engages with the handle portion 11. Thereafter, as shown in FIG. 24C, the battery engaging portion 24 moves away from the bus 2, and the battery 3 starts to be transferred from the battery mount 6 to the battery mounting portion 22. When the battery engaging portion 24 moves by a predetermined amount and the battery 3 is completely mounted on the battery mounting portion 22 as shown in FIG. 24D, thereafter, the battery mounting portion 22 and the battery engaging portion 24 are moved. While synchronizing, as shown in FIG. 24E, the battery 3 moves away from the bus 2 to complete the extraction of the battery 3 from the bus 2. When the extraction of the battery 3 from the bus 2 is completed, the robot 5 rotates 180 ° and accommodates the battery 3 in the buffer station.

その後、バス2の、バッテリー3が引き抜かれた部分へのバッテリー3の差込み動作が行われる(ステップS3)。ステップS3では、具体的には、ロボット5によってバッファステーションから充電済みのバッテリー3が取り出され(ステップS31)、その後、取り出されたバッテリー3がバス2に差し込まれる(ステップS32)。   Thereafter, the battery 3 is inserted into the portion of the bus 2 from which the battery 3 has been pulled out (step S3). Specifically, in step S3, the charged battery 3 is removed from the buffer station by the robot 5 (step S31), and then the removed battery 3 is inserted into the bus 2 (step S32).

ステップS3において、ロボット5は、バッファステーションから充電済みのバッテリー3を取り出すと、180°回動して、図25(A)に示すように、バス2からのバッテリー3の引抜き完了時と同じ状態になる。その後、図25(B)に示すように、バッテリー搭載部22およびバッテリー係合部24が同期しながら、バス2に近づく方向へ移動する。バッテリー搭載部22からバッテリー置き台6へのバッテリー3の載り移りが可能な位置までバッテリー搭載部22が移動すると、図25(C)に示すように、バッテリー係合部24がバス2に近づく方向へ移動して、バス2へのバッテリー3の差込みを行う。バス2にバッテリー3が差し込まれると、図25(D)に示すように、係合爪部41が上昇し、図25(E)に示すように、バッテリー搭載部22およびバッテリー係合部24がバス2から離れる方向へ移動して(具体的には、ホームポジションまで移動して)、バス2へのバッテリー3の差込みが完了する。   In step S3, when the robot 5 takes out the charged battery 3 from the buffer station, the robot 5 rotates 180 ° and is in the same state as when the battery 3 is completely removed from the bus 2 as shown in FIG. become. Thereafter, as shown in FIG. 25B, the battery mounting portion 22 and the battery engaging portion 24 move in a direction approaching the bus 2 while being synchronized. When the battery mounting portion 22 moves to a position where the battery 3 can be transferred from the battery mounting portion 22 to the battery mount 6, the battery engaging portion 24 approaches the bus 2 as shown in FIG. The battery 3 is inserted into the bus 2. When the battery 3 is inserted into the bus 2, as shown in FIG. 25 (D), the engaging claw portion 41 is raised, and as shown in FIG. 25 (E), the battery mounting portion 22 and the battery engaging portion 24 are After moving away from the bus 2 (specifically, moving to the home position), the insertion of the battery 3 into the bus 2 is completed.

ステップS2およびS3での動作は、停止しているバス2において交換が必要なバッテリー3の交換が完了するまで(ステップS4において“Yes”になるまで)繰り返される。通常は、停止しているバス2の全てのバッテリー3が交換されるまで繰り返される。交換が必要なバッテリー3の交換が完了すると、ロボット5が原点位置へ復帰して(ステップS5)、ロボット5によるバッテリー3の交換動作が終了する。   The operations in steps S2 and S3 are repeated until the replacement of the battery 3 that needs to be replaced in the stopped bus 2 is completed (until "Yes" in step S4). Usually, it repeats until all the batteries 3 of the bus | bath 2 which has stopped are replaced | exchanged. When the replacement of the battery 3 that needs to be replaced is completed, the robot 5 returns to the origin position (step S5), and the replacement operation of the battery 3 by the robot 5 ends.

(バッテリー交換ロボットの教示方法)
図26は、図2に示すバッテリー交換ロボット5によるバス2からのバッテリー3の引抜き動作時のバッテリー搭載部22およびバッテリー係合部24の動作の軌跡を説明するための図である。図27は、図2に示すバッテリー交換ロボット5によるバス2へのバッテリー3の差込み動作時のバッテリー搭載部22およびバッテリー係合部24の動作の軌跡を説明するための図である。図28は、図2に示すバッテリー交換ロボット5によるバス2からのバッテリー3の引抜き動作時のバッテリー搭載部22およびバッテリー係合部24の動作の軌跡であってバッテリー検出位置P20を経由する場合の軌跡を説明するための図である。
(Battery replacement robot teaching method)
FIG. 26 is a diagram for explaining the trajectories of the operation of the battery mounting portion 22 and the battery engaging portion 24 when the battery 3 is pulled out of the bus 2 by the battery replacement robot 5 shown in FIG. FIG. 27 is a view for explaining the trajectory of the operation of the battery mounting portion 22 and the battery engaging portion 24 when the battery 3 is inserted into the bus 2 by the battery exchange robot 5 shown in FIG. FIG. 28 is a trajectory of the operation of the battery mounting portion 22 and the battery engaging portion 24 when the battery 3 is withdrawn from the bus 2 by the battery exchange robot 5 shown in FIG. 2 and passes through the battery detection position P20. It is a figure for demonstrating a locus | trajectory.

バッテリー交換システム1においては、ロボット5を適切に動作させてバス2のバッテリー3を適切に交換するため、所定の基準位置に停止しているバス2を用いて、ロボット5の教示(ティーチング)を行う。ロボット5の教示においては、バス2の位置を検出するためのバス検出位置と、4つのバッテリー3のそれぞれの位置を検出するためのバッテリー検出位置と、4つのバッテリー3のそれぞれの引抜きおよび差込みを行うための抜差位置とが、作業者によるマニュアル操作でロボット5に教示される。   In the battery exchange system 1, in order to properly operate the robot 5 and replace the battery 3 of the bus 2 appropriately, teaching (teaching) of the robot 5 is performed using the bus 2 stopped at a predetermined reference position. Do. In the teaching of the robot 5, the bus detection position for detecting the position of the bus 2, the battery detection position for detecting the position of each of the four batteries 3, and the extraction and insertion of each of the four batteries 3 are performed. The insertion / extraction position to perform is taught to the robot 5 by a manual operation by an operator.

バス検出位置の教示では、検出機構21による検出用プレート9の検出が可能となる位置(状態)がロボット5に教示される。バッテリー検出位置の教示では、2個の検出機構21による一対の検出用マーク8の検出が可能となる位置(状態)がロボット5に教示される。また、バッテリー検出位置の教示では、4組設けられている一対の検出用マーク8のそれぞれの検出が可能となる4つの位置がロボット5に教示される。   In the teaching of the bus detection position, the robot 5 is taught a position (state) where the detection mechanism 21 can detect the detection plate 9. In teaching the battery detection position, the robot 5 is taught a position (state) at which the two detection mechanisms 21 can detect the pair of detection marks 8. In the teaching of the battery detection position, the robot 5 is taught four positions at which each of the pair of detection marks 8 provided in the four sets can be detected.

抜差位置の教示では、図24(A)および図25(E)に示す待機位置(状態)P1と、図24(B)および図25(D)に示す車両搭載位置(状態)P2と、図24(C)に示す第1バッテリー乗継位置(状態)P3と、図25(C)に示す第2バッテリー乗継位置(状態)P4と、図24(D)および図25(B)に示すロボット搭載位置(状態)P5と、図24(E)および図25(A)に示すロボット収容位置(状態)P6とがロボット5に教示される。   In the teaching of the slip position, a standby position (state) P1 shown in FIGS. 24 (A) and 25 (E), a vehicle mounting position (state) P2 shown in FIGS. 24 (B) and 25 (D), The first battery connection position (state) P3 shown in FIG. 24 (C), the second battery connection position (state) P4 shown in FIG. 25 (C), and FIGS. 24 (D) and 25 (B). The robot mounting position (state) P5 shown and the robot housing position (state) P6 shown in FIGS. 24 (E) and 25 (A) are taught to the robot 5.

待機位置P1は、バッテリー搭載部22とバッテリー係合部24とがバス2から離れた状態で(より具体的には、ホームポジションで)待機するとともにバッテリー置き台6にバッテリー3が搭載されているときの位置である。車両搭載位置P2は、バス2に近づいているバッテリー係合部24の係合爪部41がバッテリー置き台6に搭載されているバッテリー3に係合可能となるとともに、バス2に近づいているバッテリー搭載部22とバッテリー3が搭載されているバッテリー置き台6との間でバッテリー3の載り移りが可能となるときの位置である。   The standby position P1 stands by in a state where the battery mounting portion 22 and the battery engagement portion 24 are separated from the bus 2 (more specifically, at the home position), and the battery 3 is mounted on the battery stand 6. Is the position of time. The vehicle mounting position P2 is such that the engaging claw portion 41 of the battery engaging portion 24 approaching the bus 2 can be engaged with the battery 3 mounted on the battery mount 6 and the battery approaching the bus 2 This is the position when the battery 3 can be transferred between the mounting portion 22 and the battery mount 6 on which the battery 3 is mounted.

第1バッテリー乗継位置P3は、バッテリー置き台6とバッテリー搭載部22との両方にバッテリー3が搭載されているときの位置である。具体的には、第1バッテリー乗継位置P3は、バッテリー置き台6からバッテリー搭載部22へバッテリー3が載り移り始めたときの位置(すなわち、バッテリー搭載部22からバッテリー置き台6へバッテリー3が載り移り終わるときの位置)である。本形態では、バッテリー搭載部22の上面に設けられている複数のローラ31およびローラ32のうちの1つのローラ31およびローラ32にバッテリー3が載っているときの位置が第1バッテリー乗継位置P3となっている。また、第1バッテリー乗継位置P3では、バッテリー搭載部22は、保持部材26よりもバス2側へ突出している。   The first battery connection position P <b> 3 is a position when the battery 3 is mounted on both the battery mount 6 and the battery mounting portion 22. Specifically, the first battery connection position P3 is a position when the battery 3 starts to be transferred from the battery mount 6 to the battery mount 22 (that is, the battery 3 is moved from the battery mount 22 to the battery mount 6). Position at the end of transfer). In this embodiment, the position when the battery 3 is mounted on one of the plurality of rollers 31 and 32 provided on the upper surface of the battery mounting portion 22 is the first battery connection position P3. It has become. Further, at the first battery connection position P <b> 3, the battery mounting portion 22 protrudes from the holding member 26 toward the bus 2.

第2バッテリー乗継位置P4は、第1バッテリー乗継位置P3と同様に、バッテリー置き台6とバッテリー搭載部22との両方にバッテリー3が搭載されているときの位置である。具体的には、第2バッテリー乗継位置P4は、バッテリー搭載部22からバッテリー置き台6へバッテリー3が載り移り始めたときの位置(すなわち、バッテリー置き台6からバッテリー搭載部22へバッテリー3が載り移り終わるときの位置)である。本形態では、複数設けられたローラ31の配置ピッチ分だけバッテリー3がバッテリー置き台6に載っているときの位置が第2バッテリー乗継位置P4となっている。また、第2バッテリー乗継位置P4では、バッテリー搭載部22は、保持部材26よりもバス2側へ突出している。   Similarly to the first battery connection position P3, the second battery connection position P4 is a position when the battery 3 is mounted on both the battery mount 6 and the battery mounting portion 22. Specifically, the second battery connection position P4 is a position when the battery 3 starts to be transferred from the battery mounting unit 22 to the battery mounting unit 6 (that is, the battery 3 is moved from the battery mounting unit 6 to the battery mounting unit 22). Position at the end of transfer). In this embodiment, the position when the battery 3 is mounted on the battery mount 6 by the arrangement pitch of the plurality of rollers 31 is the second battery connection position P4. Further, at the second battery connection position P4, the battery mounting portion 22 protrudes from the holding member 26 to the bus 2 side.

ロボット搭載位置P5は、バス2に近づいているバッテリー搭載部22にバッテリー3が完全に搭載されているとともに係合爪部41がバッテリー3に係合しているときの位置である。ロボット収容位置P6は、バッテリー3が搭載されているバッテリー搭載部22およびバッテリー3に係合しているバッテリー係合部24がバス2から離れて保持部材26に収容されているときの位置である。   The robot mounting position P <b> 5 is a position when the battery 3 is completely mounted on the battery mounting portion 22 approaching the bus 2 and the engagement claw portion 41 is engaged with the battery 3. The robot housing position P6 is a position when the battery mounting portion 22 on which the battery 3 is mounted and the battery engaging portion 24 engaged with the battery 3 are separated from the bus 2 and stored in the holding member 26. .

また、抜差位置の教示では、バス2に搭載される4個のバッテリー3のそれぞれについて、待機位置P1と車両搭載位置P2と第1バッテリー乗継位置P3と第2バッテリー乗継位置P4とロボット搭載位置P5とロボット収容位置P6とがロボット5に教示される。   In the teaching of the slip position, for each of the four batteries 3 mounted on the bus 2, the standby position P1, the vehicle mounting position P2, the first battery connection position P3, the second battery connection position P4, and the robot The mounting position P5 and the robot housing position P6 are taught to the robot 5.

バス2からのバッテリー3の引抜き時には、ロボット5は、待機位置P1、車両搭載位置P2、第1バッテリー乗継位置P3、ロボット搭載位置P5およびロボット収容位置P6をこの順番で移動するように動作して、バス2からのバッテリー3の引抜きを行う。また、バス2へのバッテリー3の差込み時には、ロボット5は、ロボット収容位置P6、ロボット搭載位置P5、第2バッテリー乗継位置P4、車両搭載位置P2および待機位置P1をこの順番で移動するように動作して、バス2へのバッテリー3の差込みを行う。なお、バス2からのバッテリー3の引抜き時には、バッテリー3の位置検出が行われるため、ロボット5は、実際には、待機位置P1からバッテリー検出位置P20を経由して車両搭載位置P2へ移動する。   When the battery 3 is withdrawn from the bus 2, the robot 5 operates to move in the order of the standby position P1, the vehicle mounting position P2, the first battery connection position P3, the robot mounting position P5, and the robot housing position P6. Then, the battery 3 is removed from the bus 2. Further, when the battery 3 is inserted into the bus 2, the robot 5 moves in this order through the robot housing position P6, the robot mounting position P5, the second battery connection position P4, the vehicle mounting position P2, and the standby position P1. In operation, the battery 3 is inserted into the bus 2. Since the position of the battery 3 is detected when the battery 3 is removed from the bus 2, the robot 5 actually moves from the standby position P1 to the vehicle mounting position P2 via the battery detection position P20.

ここで、バッテリー3の1個当たりの重量は、数百kgであるため、バッテリー置き台6とバッテリー搭載部22との間でバッテリー3が移動する過程で、バッテリー置き台6の高さや傾き、および、バッテリー搭載部22の高さや傾きが変動する。本形態では、バッテリー置き台6およびバッテリー搭載部22の高さや傾きの変動に起因してバッテリー置き台6とバッテリー搭載部22との間に高低差が生じるのを抑制するため、バス2からのバッテリー3の引抜き時には、第1バッテリー乗継位置P3からロボット搭載位置P5へロボット5が移動する際に昇降機構18がバッテリー抜差機構17を上昇させ、バス2へのバッテリー3の差込み時には、ロボット搭載位置P5から第2バッテリー乗継位置P4へロボット5が移動する際に昇降機構18がバッテリー抜差機構17を下降させる。   Here, since the weight of each battery 3 is several hundred kg, in the process of moving the battery 3 between the battery mount 6 and the battery mounting portion 22, In addition, the height and inclination of the battery mounting portion 22 varies. In this embodiment, in order to suppress the occurrence of a height difference between the battery mount 6 and the battery mounting portion 22 due to variations in the height and inclination of the battery mount 6 and the battery mounting portion 22, When the battery 3 is pulled out, the lifting mechanism 18 raises the battery pulling mechanism 17 when the robot 5 moves from the first battery transfer position P3 to the robot mounting position P5, and when the battery 3 is plugged into the bus 2, the robot 3 When the robot 5 moves from the mounting position P5 to the second battery connection position P4, the elevating mechanism 18 lowers the battery insertion / removal mechanism 17.

そのため、ロボット5の教示結果に基づいてバス2からのバッテリー3の引抜き動作を行うと、バッテリー搭載部22の任意の一点は、図26に示すように、矢印V1、V2、V3に沿う軌跡を描きながら、待機位置P1、車両搭載位置P2、第1バッテリー乗継位置P3、ロボット搭載位置P5およびロボット収容位置P6をこの順番で移動する。また、バス2からのバッテリー3の引抜き動作を行うと、バッテリー係合部24の任意の一点は、図26に示すように、矢印V4、V5、V6、V7に沿う軌跡を描きながら、待機位置P1、車両搭載位置P2、第1バッテリー乗継位置P3、ロボット搭載位置P5およびロボット収容位置P6をこの順番で移動する。   Therefore, when the operation of pulling out the battery 3 from the bus 2 is performed based on the teaching result of the robot 5, an arbitrary point of the battery mounting portion 22 follows a locus along arrows V1, V2, and V3 as shown in FIG. While drawing, the standby position P1, the vehicle mounting position P2, the first battery connection position P3, the robot mounting position P5, and the robot housing position P6 are moved in this order. When the battery 3 is pulled out from the bus 2, any one point of the battery engaging portion 24 is in a standby position while drawing a locus along arrows V4, V5, V6, V7 as shown in FIG. P1, the vehicle mounting position P2, the first battery connection position P3, the robot mounting position P5, and the robot housing position P6 are moved in this order.

また、ロボット5の教示結果に基づいてバス2へのバッテリー3の差込み動作を行うと、バッテリー搭載部22の任意の一点は、図27に示すように、矢印V11、V12、V13に沿う軌跡を描きながら、ロボット収容位置P6、ロボット搭載位置P5、第2バッテリー乗継位置P4、車両搭載位置P2および待機位置P1をこの順番で移動する。また、バス2へのバッテリー3の差込み動作を行うと、バッテリー係合部24の任意の一点は、図27に示すように、矢印V14、V15、V16、V17に沿う軌跡を描きながら、ロボット収容位置P6、ロボット搭載位置P5、第2バッテリー乗継位置P4、車両搭載位置P2および待機位置P1をこの順番で移動する。   Further, when the battery 3 is inserted into the bus 2 based on the teaching result of the robot 5, any one point of the battery mounting portion 22 follows a path along arrows V11, V12, V13 as shown in FIG. While drawing, the robot housing position P6, the robot mounting position P5, the second battery connection position P4, the vehicle mounting position P2, and the standby position P1 are moved in this order. When the battery 3 is inserted into the bus 2, any one point of the battery engaging portion 24 is accommodated in the robot while drawing a locus along arrows V14, V15, V16, V17 as shown in FIG. The position P6, the robot mounting position P5, the second battery connection position P4, the vehicle mounting position P2, and the standby position P1 are moved in this order.

なお、バス2からのバッテリー3の引抜き動作を行うときには、バッテリー3の位置検出が行われる。バッテリー搭載部22およびバッテリー係合部24がバッテリー検出位置P20を経由する場合には、バス2からのバッテリー3の引抜き動作を行う際のバッテリー搭載部22の任意の一点の軌跡は、図28(B)に示すように、矢印V21、V22、V23、V24に沿う軌跡となり、バッテリー係合部24の任意の一点の軌跡は、図28(A)に示すように、矢印V25、V26、V27、V28、V29に沿う軌跡となる。   When the battery 3 is pulled out from the bus 2, the position of the battery 3 is detected. When the battery mounting portion 22 and the battery engaging portion 24 pass through the battery detection position P20, the locus of an arbitrary point of the battery mounting portion 22 when the battery 3 is pulled out from the bus 2 is shown in FIG. As shown in FIG. 28B, the trajectory along the arrows V21, V22, V23, and V24, and the trajectory at an arbitrary point of the battery engaging portion 24, as shown in FIG. It becomes a locus along V28 and V29.

(バッテリー検出位置の校正およびバス検出位置の校正)
ロボット5の教示が終わると、所定の基準位置にバス2が停止しているときに検出機構21によって検出用マーク8が実際に検出される検出位置と、教示されたバッテリー検出位置とのずれを補正して、所定の基準位置にバス2が停止しているときの一対の検出用マーク8の位置を正確に把握するため、バッテリー検出位置の校正を行う。バッテリー検出位置の校正は、教示されたバッテリー検出位置を基準位置とし、2個の検出機構21を用いて一対の検出用マーク8を検出することで行われる。このバッテリー検出位置の校正は、4組設けられている一対の検出用マーク8のそれぞれについて行われる。
(Calibration of battery detection position and calibration of bus detection position)
When the teaching of the robot 5 is finished, a deviation between the detection position where the detection mark 8 is actually detected by the detection mechanism 21 when the bus 2 is stopped at the predetermined reference position and the taught battery detection position is detected. In order to correct the position of the pair of detection marks 8 when the bus 2 is stopped at a predetermined reference position, the battery detection position is calibrated. The calibration of the battery detection position is performed by detecting the pair of detection marks 8 using the two detection mechanisms 21 with the taught battery detection position as a reference position. The calibration of the battery detection position is performed for each of the four pairs of detection marks 8 provided.

また、所定の基準位置にバス2が停止しているときに検出機構21によって検出用プレート9が実際に検出される検出位置と、教示されたバス検出位置とのずれを補正して、所定の基準位置にバス2が停止しているときの検出用プレート9の位置を正確に把握するため、バス検出位置の校正を行う。バス検出位置の校正は、教示されたバス検出位置を基準位置とし、検出機構21を用いて検出用プレート9を検出することで行われる。   Further, by correcting the deviation between the detection position where the detection plate 9 is actually detected by the detection mechanism 21 when the bus 2 is stopped at the predetermined reference position and the taught bus detection position, In order to accurately grasp the position of the detection plate 9 when the bus 2 is stopped at the reference position, the bus detection position is calibrated. The bus detection position is calibrated by detecting the detection plate 9 using the detection mechanism 21 with the taught bus detection position as a reference position.

(教示データおよび校正データの記憶)
図29は、図2に示すバッテリー収容部4の正面図である。図30は、図2に示すバッテリー交換ロボット5の制御部91の記憶部92および第2記憶部93に記憶されているデータの一部を説明するためのブロック図である。
(Storing teaching data and calibration data)
FIG. 29 is a front view of the battery accommodating portion 4 shown in FIG. FIG. 30 is a block diagram for explaining a part of the data stored in the storage unit 92 and the second storage unit 93 of the control unit 91 of the battery exchange robot 5 shown in FIG.

上述のように、本形態のバス2には、4個のバッテリー3が搭載可能になっており、バッテリー収容部4には、4組の一対の検出用マーク8が設けられている。以下では、4個のバッテリー3を区別して表す場合には、図29に示すように、4個のバッテリー3のそれぞれをバッテリー3A、バッテリー3B、バッテリー3Cおよびバッテリー3Dとする。また、4組の一対の検出用マーク8を区別して表わす場合には、図29に示すように、バッテリー3Aが搭載されるバッテリー置き台6に形成される検出用マーク8を検出用マーク8A、バッテリー3Bが搭載されるバッテリー置き台6に形成される検出用マーク8を検出用マーク8B、バッテリー3Cが搭載されるバッテリー置き台6に形成される検出用マーク8を検出用マーク8C、バッテリー3Dが搭載されるバッテリー置き台6に形成される検出用マーク8を検出用マーク8Dとする。   As described above, four batteries 3 can be mounted on the bus 2 of the present embodiment, and the battery housing portion 4 is provided with four pairs of detection marks 8. Hereinafter, when the four batteries 3 are distinguished from each other, as shown in FIG. 29, each of the four batteries 3 is referred to as a battery 3A, a battery 3B, a battery 3C, and a battery 3D. When the four pairs of detection marks 8 are distinguished from each other, as shown in FIG. 29, the detection marks 8 formed on the battery mount 6 on which the battery 3A is mounted are replaced with the detection marks 8A, The detection mark 8 formed on the battery mount 6 on which the battery 3B is mounted is the detection mark 8B, the detection mark 8 formed on the battery mount 6 on which the battery 3C is mounted is the detection mark 8C, and the battery 3D. The detection mark 8 formed on the battery mount 6 on which is mounted is defined as a detection mark 8D.

ロボット5を制御する制御部91は、記憶部92と第2記憶部93とを備えている。記憶部92は、たとえば、フラッシュメモリであり、第2記憶部93は、たとえば、RAM(Random Access Memory)である。記憶部92には、図30に示すように、ロボット5の教示データと、バッテリー検出位置の校正データおよびバス検出位置の校正データとが記憶されている。   The control unit 91 that controls the robot 5 includes a storage unit 92 and a second storage unit 93. The storage unit 92 is, for example, a flash memory, and the second storage unit 93 is, for example, a RAM (Random Access Memory). As shown in FIG. 30, the storage unit 92 stores teaching data for the robot 5, calibration data for the battery detection position, and calibration data for the bus detection position.

すなわち、記憶部92には、バッテリー3Aの抜差位置の教示データである抜差位置教示データA、バッテリー3Bの抜差位置の教示データである抜差位置教示データB、バッテリー3Cの抜差位置の教示データである抜差位置教示データC、および、バッテリー3Dの抜差位置の教示データである抜差位置教示データDが教示データとして記憶されるとともに、一対の検出用マーク8Aの検出が可能となるバッテリー検出位置の教示データであるバッテリー検出位置教示データA、一対の検出用マーク8Bの検出が可能となるバッテリー検出位置の教示データであるバッテリー検出位置教示データB、一対の検出用マーク8Cの検出が可能となるバッテリー検出位置の教示データであるバッテリー検出位置教示データC、および、一対の検出用マーク8Dの検出が可能となるバッテリー検出位置の教示データであるバッテリー検出位置教示データDが教示データとして記憶されている。また、記憶部92には、バス検出位置の教示データであるバス検出位置教示データが記憶されている。   That is, in the storage unit 92, the insertion / removal position teaching data A which is teaching data of the insertion / removal position of the battery 3A, the insertion / removal position teaching data B which is teaching data of the insertion / removal position of the battery 3B, and the insertion / removal position of the battery 3C The teaching position data C and the teaching position data D of the battery 3D are stored as teaching data, and a pair of detection marks 8A can be detected. Battery detection position teaching data A, which is battery detection position teaching data, and battery detection position teaching data B, which is battery detection position teaching data capable of detecting a pair of detection marks 8B, and a pair of detection marks 8C. Battery detection position teaching data C, which is teaching data of the battery detection position that enables detection of Battery detection position teaching data D which is teaching data of a battery detection position where the detection of the use mark 8D becomes possible are stored as teaching data. The storage unit 92 stores bus detection position teaching data which is teaching data of the bus detection position.

また、記憶部92には、一対の検出用マーク8Aの検出が可能となるバッテリー検出位置の校正データであるバッテリー検出位置校正データA、一対の検出用マーク8Bの検出が可能となるバッテリー検出位置の校正データであるバッテリー検出位置校正データB、一対の検出用マーク8Cの検出が可能となるバッテリー検出位置の校正データであるバッテリー検出位置校正データC、および、一対の検出用マーク8Dの検出が可能となるバッテリー検出位置の校正データであるバッテリー検出位置校正データDが記憶されるとともに、バス検出位置の校正データであるバス検出位置校正データが記憶されている。   The storage unit 92 also includes battery detection position calibration data A, which is calibration data of battery detection positions that enable detection of a pair of detection marks 8A, and battery detection positions that enable detection of a pair of detection marks 8B. The battery detection position calibration data B, which is the calibration data of the battery, the battery detection position calibration data C, which is the calibration data of the battery detection position that enables detection of the pair of detection marks 8C, and the detection of the pair of detection marks 8D. Battery detection position calibration data D that is calibration data of battery detection positions that can be stored is stored, and bus detection position calibration data that is calibration data of bus detection positions is stored.

記憶部92では、抜差位置教示データAとバッテリー検出位置校正データAとがバッテリー3Aの交換用のデータとして記憶され、抜差位置教示データBとバッテリー検出位置校正データBとがバッテリー3Bの交換用のデータとして記憶され、抜差位置教示データCとバッテリー検出位置校正データCとがバッテリー3Cの交換用のデータとして記憶され、抜差位置教示データDとバッテリー検出位置校正データDとがバッテリー3Dの交換用のデータとして記憶されている。すなわち、記憶部92では、あるバッテリー3の抜差位置教示データと、そのバッテリー3が搭載されるバッテリー置き台6に形成される検出用マーク8に関するバッテリー検出位置校正データとがそのバッテリー3の交換用のデータとして記憶されている。   In the storage unit 92, the differential position teaching data A and the battery detection position calibration data A are stored as replacement data for the battery 3A, and the differential position teaching data B and the battery detection position calibration data B are exchanged for the battery 3B. Are stored as data for replacement, battery position teaching data C and battery detection position calibration data C are stored as replacement data for battery 3C, and battery position teaching data D and battery detection position calibration data D are stored in battery 3D. Is stored as replacement data. That is, in the storage unit 92, the insertion / extraction position teaching data of a certain battery 3 and the battery detection position calibration data regarding the detection mark 8 formed on the battery mount 6 on which the battery 3 is mounted are exchanged for the battery 3. It is stored as data for use.

そのため、バッテリー3の交換時に、後述のように、ロボット5が電気的に接続される外部装置(図示省略)によって交換されるバッテリー3が指定されると、制御部91では、指定されたバッテリー3の抜差位置の教示データと、そのバッテリー3が搭載されるバッテリー置き台6に形成される検出用マーク8に関するバッテリー検出位置の校正データとが読み出される。   For this reason, when the battery 3 is replaced, if the battery 3 to be replaced is designated by an external device (not shown) to which the robot 5 is electrically connected as described later, the controller 91 designates the designated battery 3. Are read out and the calibration data of the battery detection position relating to the detection mark 8 formed on the battery mount 6 on which the battery 3 is mounted are read out.

(バッテリー交換ロボットの制御方法)
図31は、図2に示すバッテリー交換ロボット5の制御方法の一例を説明するためのフローチャートである。
(Control method for battery exchange robot)
FIG. 31 is a flowchart for explaining an example of a control method of the battery exchange robot 5 shown in FIG.

バッテリー交換システム1では、バッテリー3が交換されるバス2が所定の停止位置に停止して、制御部91が外部装置からバス2の位置検出指令信号を受信すると、上述の手順でバス2の位置検出が行われる(ステップS61)。ステップS61では、記憶部92からバス検出位置教示データが読み出され、この教示データを基準にロボット5が動作して、停止しているバス2の実際の位置が検出される。ステップS61で検出されたバス2の位置は、バス停止位置データとして、制御部91の第2記憶部93に記憶される。   In the battery exchange system 1, when the bus 2 where the battery 3 is exchanged stops at a predetermined stop position and the control unit 91 receives a position detection command signal for the bus 2 from an external device, the position of the bus 2 is determined according to the above procedure. Detection is performed (step S61). In step S61, the bus detection position teaching data is read from the storage unit 92, the robot 5 is operated based on the teaching data, and the actual position of the stopped bus 2 is detected. The position of the bus 2 detected in step S61 is stored in the second storage unit 93 of the control unit 91 as bus stop position data.

その後、制御部91において、バス2の基準停止位置と、バッテリー3が交換されるバス2が実際に停止している位置との差であるバス位置偏差の量(バス位置偏差量)が算出される(ステップS62)。ステップS62では、記憶部92からバス検出位置校正データが読み出されるとともに、第2記憶部93からバス停止位置データが読み出される。また、これらのデータを比較することで、バス位置偏差量が算出される。ステップS62で算出されたバス位置偏差量は、バス位置偏差量データとして、第2記憶部93に記憶される。   Thereafter, the controller 91 calculates a bus position deviation amount (bus position deviation amount) which is a difference between the reference stop position of the bus 2 and the position where the bus 2 where the battery 3 is replaced is actually stopped. (Step S62). In step S62, the bus detection position calibration data is read from the storage unit 92, and the bus stop position data is read from the second storage unit 93. Further, the bus position deviation amount is calculated by comparing these data. The bus position deviation amount calculated in step S62 is stored in the second storage unit 93 as bus position deviation amount data.

その後、制御部91において、バス2が実際に停止している位置に基づく検出用マーク8の修正位置が計算される(ステップS63)。ステップS63では、記憶部92からバッテリー検出位置教示データが読み出されるとともに、第2記憶部93からバス位置偏差量データが読み出される。また、バッテリー検出位置教示データの値にバス位置偏差量データの値を加算等することで、バス2が実際に停止している位置に基づく検出用マーク8の修正位置である修正検出用マーク位置が計算される。ステップS63で計算された修正検出用マーク位置は、修正検出用マーク位置データとして、第2記憶部93に記憶される。   Thereafter, the control unit 91 calculates the correction position of the detection mark 8 based on the position where the bus 2 is actually stopped (step S63). In step S63, the battery detection position teaching data is read from the storage unit 92, and the bus position deviation amount data is read from the second storage unit 93. Further, by adding the value of the bus position deviation amount data to the value of the battery detection position teaching data, the correction detection mark position which is the correction position of the detection mark 8 based on the position where the bus 2 is actually stopped. Is calculated. The correction detection mark position calculated in step S63 is stored in the second storage unit 93 as correction detection mark position data.

なお、ステップS63では、バッテリー検出位置教示データA〜バッテリー検出位置教示データDのそれぞれが記憶部92から読み出され、4組の一対の検出用マーク8A〜8Dのそれぞれについて、修正検出用マーク位置が計算される。図30に示すように、一対の検出用マーク8Aについて計算された修正検出用マーク位置は、修正検出用マーク位置データAとして第2記憶部93に記憶され、一対の検出用マーク8Bについて計算された修正検出用マーク位置は、修正検出用マーク位置データBとして第2記憶部93に記憶され、一対の検出用マーク8Cについて計算された修正検出用マーク位置は、修正検出用マーク位置データCとして第2記憶部93に記憶され、一対の検出用マーク8Dについて計算された修正検出用マーク位置は、修正検出用マーク位置データDとして第2記憶部93に記憶される。   In step S63, each of the battery detection position teaching data A to battery detection position teaching data D is read from the storage unit 92, and the correction detection mark position for each of the four pairs of detection marks 8A to 8D. Is calculated. As shown in FIG. 30, the correction detection mark positions calculated for the pair of detection marks 8A are stored in the second storage unit 93 as correction detection mark position data A, and are calculated for the pair of detection marks 8B. The correction detection mark position is stored in the second storage section 93 as correction detection mark position data B, and the correction detection mark position calculated for the pair of detection marks 8C is used as correction detection mark position data C. The correction detection mark positions stored in the second storage unit 93 and calculated for the pair of detection marks 8D are stored in the second storage unit 93 as correction detection mark position data D.

また、第2記憶部93では、修正検出用マーク位置データAがバッテリー3Aの交換用のデータとして記憶され、修正検出用マーク位置データBがバッテリー3Bの交換用のデータとして記憶され、修正検出用マーク位置データCがバッテリー3Cの交換用のデータとして記憶され、修正検出用マーク位置データDがバッテリー3Dの交換用のデータとして記憶される。すなわち、第2記憶部93では、あるバッテリー3が搭載されるバッテリー置き台6に形成される検出用マーク8について計算された修正検出用マーク位置データがそのバッテリー3の交換用のデータとして記憶される。   In the second storage unit 93, the correction detection mark position data A is stored as replacement data for the battery 3A, and the correction detection mark position data B is stored as replacement data for the battery 3B. The mark position data C is stored as replacement data for the battery 3C, and the correction detection mark position data D is stored as replacement data for the battery 3D. That is, the second storage unit 93 stores the correction detection mark position data calculated for the detection mark 8 formed on the battery mount 6 on which a certain battery 3 is mounted as replacement data for the battery 3. The

その後、制御部91は、バス2に搭載される4個のバッテリー3のうちの交換されるバッテリー3を指定するバッテリー指定信号を外部装置から受け取る。制御部91がバッテリー指定信号を受け取ると、指定されたバッテリー3が搭載されるバッテリー置き台6の検出用マーク8の位置検出が上述の手順で行われる(ステップS64)。上述のように、第2記憶部93では、あるバッテリー3が搭載されるバッテリー置き台6に形成される検出用マーク8について計算された修正検出用マーク位置データがそのバッテリー3の交換用のデータとして記憶されているため、ステップS64では、指定されたバッテリー3が搭載されるバッテリー置き台6に形成される検出用マーク8について計算された修正検出用マーク位置データが第2記憶部93から読み出される。たとえば、バッテリー3Aが指定された場合には、修正検出用マーク位置データAが第2記憶部93から読み出され、バッテリー3Bが指定された場合には、修正検出用マーク位置データBが第2記憶部93から読み出される。また、ステップS64では、読み出された修正検出用マーク位置データを基準にロボット5が動作して、指定されたバッテリー3が搭載されるバッテリー置き台6の検出用マーク8の実際の位置が検出される。   Thereafter, the control unit 91 receives a battery designation signal for designating the battery 3 to be replaced among the four batteries 3 mounted on the bus 2 from the external device. When the controller 91 receives the battery designation signal, the position detection of the detection mark 8 of the battery cradle 6 on which the designated battery 3 is mounted is performed according to the above procedure (step S64). As described above, in the second storage unit 93, the correction detection mark position data calculated for the detection mark 8 formed on the battery mount 6 on which a certain battery 3 is mounted is the replacement data for the battery 3. Therefore, in step S64, the correction detection mark position data calculated for the detection mark 8 formed on the battery mount 6 on which the designated battery 3 is mounted is read from the second storage unit 93. It is. For example, when the battery 3A is designated, the correction detection mark position data A is read from the second storage unit 93, and when the battery 3B is designated, the correction detection mark position data B is second. Read from the storage unit 93. In step S64, the robot 5 operates based on the read correction detection mark position data, and the actual position of the detection mark 8 of the battery cradle 6 on which the designated battery 3 is mounted is detected. Is done.

その後、制御部91において、検出用マーク8の基準位置と、ステップS64で検出された検出用マーク8の実際の位置との差である検出用マーク位置偏差の量(検出用マーク位置偏差量)が算出される(ステップS65)。ステップS65では、記憶部92からバッテリー検出位置校正データが読み出される。上述のように、記憶部92では、あるバッテリー3が搭載されるバッテリー置き台6に形成される検出用マーク8に関するバッテリー検出位置校正データがそのバッテリー3の交換用のデータとして記憶されているため、ステップS65では、指定されたバッテリー3が搭載されるバッテリー置き台6に形成される検出用マーク8に関するバッテリー検出位置の校正データが記憶部92から読み出される。たとえば、バッテリー3Aが指定された場合には、バッテリー検出位置校正データAが記憶部92から読み出され、バッテリー3Bが指定された場合には、バッテリー検出位置校正データBが記憶部92から読み出される。また、ステップS65では、ステップS64で検出された検出用マーク8の位置のデータと読み出されたバッテリー検出位置校正データとを比較することで、検出用マーク位置偏差量が算出される。ステップS65で算出された検出用マーク位置偏差量は、検出用マーク位置偏差量データとして、第2記憶部93に記憶される。   Thereafter, in the control unit 91, a detection mark position deviation amount (detection mark position deviation amount) which is a difference between the reference position of the detection mark 8 and the actual position of the detection mark 8 detected in step S64. Is calculated (step S65). In step S65, battery detection position calibration data is read from the storage unit 92. As described above, in the storage unit 92, the battery detection position calibration data regarding the detection mark 8 formed on the battery mount 6 on which a certain battery 3 is mounted is stored as replacement data for the battery 3. In step S65, calibration data of the battery detection position relating to the detection mark 8 formed on the battery mount 6 on which the designated battery 3 is mounted is read from the storage unit 92. For example, when the battery 3A is designated, the battery detection position calibration data A is read from the storage unit 92, and when the battery 3B is designated, the battery detection position calibration data B is read from the storage unit 92. . In step S65, the detection mark position deviation amount is calculated by comparing the data of the position of the detection mark 8 detected in step S64 with the read battery detection position calibration data. The detection mark position deviation amount calculated in step S65 is stored in the second storage unit 93 as detection mark position deviation amount data.

その後、制御部91において、指定されたバッテリー3の引抜きおよび差込みを行うための抜差位置の補正位置が算出される(ステップS66)。ステップS66では、記憶部92から抜差位置教示データが読み出される。具体的には、ステップS66では、指定されたバッテリー3の抜差位置教示データが記憶部92から読み出される。たとえば、バッテリー3Aが指定された場合には、抜差位置教示データAが記憶部92から読み出され、バッテリー3Bが指定された場合には、抜差位置教示データBが記憶部92から読み出される。また、ステップS66では、第2記憶部93から検出用マーク位置偏差量データが読み出され、抜差位置教示データの値に検出用マーク位置偏差量データの値を加算等することで、抜差位置の補正位置が算出される。すなわち、ステップS66では、抜差位置教示データが補正される。ステップS66で算出される抜差位置の補正位置は、具体的には、車両搭載位置P2の補正位置と、第1バッテリー乗継位置P3の補正位置と、第2バッテリー乗継位置P4の補正位置と、ロボット搭載位置P5の補正位置である。また、ステップS66で算出された抜差位置の補正位置は、補正抜差位置データとして第2記憶部93に記憶される。   Thereafter, the controller 91 calculates a correction position of the insertion / removal position for extracting and inserting the designated battery 3 (step S66). In step S66, the insertion / extraction position teaching data is read from the storage unit 92. Specifically, in step S <b> 66, the specified insertion / extraction position teaching data of the battery 3 is read from the storage unit 92. For example, when the battery 3A is designated, the plug position teaching data A is read from the storage unit 92, and when the battery 3B is designated, the plug position teaching data B is read from the storage unit 92. . In step S66, the detection mark position deviation amount data is read from the second storage section 93, and the value of the detection mark position deviation amount data is added to the value of the difference position teaching data, thereby making it possible to detect the difference. A position correction position is calculated. That is, in step S66, the differential position teaching data is corrected. Specifically, the correction position of the slip position calculated in step S66 is the correction position of the vehicle mounting position P2, the correction position of the first battery connection position P3, and the correction position of the second battery connection position P4. And the correction position of the robot mounting position P5. Further, the correction position of the slip position calculated in step S66 is stored in the second storage unit 93 as corrected slip position data.

その後、ロボット5が車両搭載位置P2の補正位置へ移動し、係合爪部41が下降してバッテリー3の取手部11に係合する(ステップS67)。ステップS67では、第2記憶部93から車両搭載位置P2の補正位置が読み出される。その後、ロボット5は、第1バッテリー乗継位置P3の補正位置、ロボット搭載位置P5の補正位置へこの順番で移動する(ステップS68、S69)。ステップS68では、第2記憶部93から第1バッテリー乗継位置P3の補正位置が読み出され、ステップS69では、第2記憶部93からロボット搭載位置P5の補正位置が読み出される。その後、ロボット5は、ロボット収容位置P6へ移動する(ステップS70)。   Thereafter, the robot 5 moves to the correction position of the vehicle mounting position P2, and the engaging claw portion 41 descends and engages with the handle portion 11 of the battery 3 (step S67). In step S67, the correction position of the vehicle mounting position P2 is read from the second storage unit 93. Thereafter, the robot 5 moves in this order to the correction position of the first battery connection position P3 and the correction position of the robot mounting position P5 (steps S68 and S69). In step S68, the correction position of the first battery connection position P3 is read from the second storage unit 93, and in step S69, the correction position of the robot mounting position P5 is read from the second storage unit 93. Thereafter, the robot 5 moves to the robot housing position P6 (step S70).

その後、ロボット5は、180°回動して、バッファステーションにバッテリー3を収容するとともに、バッファステーションから充電済みのバッテリー3を取り出し180°回動してから(ステップS71)、ロボット搭載位置P5の補正位置へ移動する(ステップS72)。ステップS72では、第2記憶部93からロボット搭載位置P5の補正位置が読み出される。その後、ロボット5は、第2バッテリー乗継位置P4の補正位置、車両搭載位置P2の補正位置へこの順番で移動する(ステップS73、S74)。ステップS73では、第2記憶部93から第2バッテリー乗継位置P4の補正位置が読み出され、ステップS74では、第2記憶部93から車両搭載位置P2の補正位置が読み出される。その後、ロボット5は、待機位置P1へ移動する(ステップS75)。   Thereafter, the robot 5 is rotated 180 ° to store the battery 3 in the buffer station, and after the charged battery 3 is taken out from the buffer station and rotated 180 ° (step S71), the robot 5 is moved to the robot mounting position P5. Move to the correction position (step S72). In step S72, the correction position of the robot mounting position P5 is read from the second storage unit 93. Thereafter, the robot 5 moves in this order to the correction position of the second battery connection position P4 and the correction position of the vehicle mounting position P2 (steps S73, S74). In step S73, the correction position of the second battery connection position P4 is read from the second storage unit 93, and in step S74, the correction position of the vehicle mounting position P2 is read from the second storage unit 93. Thereafter, the robot 5 moves to the standby position P1 (step S75).

図23に示すフローチャートを用いて説明したように、ステップS64〜S75までの動作は、停止しているバス2において交換が必要なバッテリー3の交換が完了するまで繰り返される。通常は、停止しているバス2の全てのバッテリー3が交換されるまで繰り返される。   As described with reference to the flowchart shown in FIG. 23, the operations from step S64 to S75 are repeated until the replacement of the battery 3 that needs to be replaced in the stopped bus 2 is completed. Usually, it repeats until all the batteries 3 of the bus | bath 2 which has stopped are replaced | exchanged.

なお、本形態では、ステップS63で計算される修正検出用マーク位置は、バッテリー3が実際に交換されるバス2の4組の一対の検出用マーク8のそれぞれの検出を検出機構21によって行うときの基準となる検出用位置であり、修正検出用マーク位置データは、検出用位置データである。また、本形態では、ロボット5の教示を行う際に、ロボット5に教示されたバッテリー検出位置は、基準位置に停止するバス2を用い4組の一対の検出用マーク8のそれぞれの位置を検出するためにロボット5に教示された検出用マーク教示位置である。   In this embodiment, the correction detection mark position calculated in step S63 is determined when the detection mechanism 21 detects each of the four pairs of detection marks 8 of the bus 2 where the battery 3 is actually replaced. The correction detection mark position data is detection position data. In this embodiment, when the robot 5 is taught, the battery detection position taught to the robot 5 is detected by detecting the position of each of the four pairs of detection marks 8 using the bus 2 that stops at the reference position. This is the detection mark teaching position taught to the robot 5.

また、本形態では、バス2の基準停止位置(すなわち、所定の基準位置にバス2が停止しているときに検出機構21によって検出用プレート9が実際に検出された位置)は車両基準位置であり、ステップS61で検出されたバス2の位置(すなわち、バッテリー3が交換されるバス2が実際に停止している位置(バッテリー3が交換されるバス2が実際に停止しているときに検出機構21によって検出用プレート9が実際に検出された位置))は車両実際位置である。また、本形態では、バス位置偏差は、車両基準位置と車両実際位置との差となる車両位置偏差である。   In this embodiment, the reference stop position of the bus 2 (that is, the position where the detection plate 9 is actually detected when the bus 2 is stopped at the predetermined reference position) is the vehicle reference position. Yes, the position of the bus 2 detected in step S61 (that is, the position where the bus 2 where the battery 3 is replaced is actually stopped (detected when the bus 2 where the battery 3 is replaced is actually stopped). The position where the detection plate 9 is actually detected by the mechanism 21)) is the actual vehicle position. In this embodiment, the bus position deviation is a vehicle position deviation that is a difference between the vehicle reference position and the vehicle actual position.

さらに、本形態では、検出用マーク8の基準位置(すなわち、所定の基準位置にバス2が停止しているときに検出機構21によって検出用マーク8が実際に検出された位置)は、検出用マーク基準位置であり、バッテリー検出位置校正データは、検出用マーク基準位置データである。また、本形態では、ステップS64で検出される検出用マーク8の位置は、第1検出用マーク実際位置であり、ステップS65で算出される検出用マーク位置偏差は、第1検出用マーク位置偏差である。また、ステップS66で読み出される抜差位置データは、第1抜差位置のデータであり、ステップS66で算出される抜差位置の補正位置は、第1補正位置である。   Further, in this embodiment, the reference position of the detection mark 8 (that is, the position where the detection mark 8 is actually detected by the detection mechanism 21 when the bus 2 is stopped at the predetermined reference position) is used for detection. The mark reference position, and the battery detection position calibration data is detection mark reference position data. In this embodiment, the position of the detection mark 8 detected in step S64 is the first detection mark actual position, and the detection mark position deviation calculated in step S65 is the first detection mark position deviation. It is. The slip position data read in step S66 is data of the first slip position, and the correction position of the slip position calculated in step S66 is the first correction position.

(本形態の主な効果)
以上説明したように、本形態では、バス2に搭載される4個のバッテリー3のうち交換されるバッテリー3を指定するバッテリー指定信号を外部装置から制御部91が受け取ると、指定されたバッテリー3が搭載されるバッテリー置き台6に形成される検出用マーク8について計算された修正検出用マーク位置データが第2記憶部93から読み出される。また、本形態では、読み出された修正検出用マーク位置データを基準にロボット5を動作させて、指定されたバッテリー3が搭載されるバッテリー置き台6の検出用マーク8の実際の位置が検出される。さらに、本形態では、指定されたバッテリー3の引抜きおよび差込みを行うための抜差位置教示データが記憶部92から読み出され、検出用マーク8の実際の位置の検出結果に基づいて、この抜差位置教示データが補正される。
(Main effects of this form)
As described above, in the present embodiment, when the control unit 91 receives a battery designation signal for designating the battery 3 to be replaced among the four batteries 3 mounted on the bus 2, the designated battery 3 is designated. The correction detection mark position data calculated for the detection mark 8 formed on the battery mount 6 on which is mounted is read from the second storage unit 93. In this embodiment, the robot 5 is operated with reference to the read correction detection mark position data, and the actual position of the detection mark 8 of the battery stand 6 on which the designated battery 3 is mounted is detected. Is done. Further, in this embodiment, the insertion / removal position teaching data for performing the specified removal and insertion of the battery 3 is read from the storage unit 92, and this extraction is performed based on the detection result of the actual position of the detection mark 8. The difference position teaching data is corrected.

すなわち、本形態では、交換されるバッテリー3が搭載されるバッテリー置き台6に形成される検出用マーク8の検出結果に基づいて、交換されるバッテリー3の抜差位置教示データを補正し、補正後の抜差位置教示データに基づいてロボット5を動作させている。そのため、本形態では、バッテリー3により近い位置に形成される検出用マーク8の検出結果に基づいて、交換されるバッテリー3の抜差位置教示データを精度良く補正するとともに、精度良く補正された抜差位置教示データに基づいてロボット5を精度良く動作させることが可能になる。したがって、本形態では、特許文献1に記載のバッテリー交換装置が有するドッキングアームをロボット5が備えていなくても、バス2に搭載される4個のバッテリー3のそれぞれを適切に交換することが可能になる。すなわち、本形態では、ロボット5の構成が簡易であっても、バス2に搭載される4個のバッテリー3のそれぞれを適切に交換することが可能になる。   In other words, in this embodiment, based on the detection result of the detection mark 8 formed on the battery cradle 6 on which the battery 3 to be replaced is mounted, the plug position teaching data of the battery 3 to be replaced is corrected, The robot 5 is operated based on the subsequent drawing position teaching data. Therefore, in the present embodiment, based on the detection result of the detection mark 8 formed at a position closer to the battery 3, the removal position teaching data of the battery 3 to be replaced is corrected with high accuracy and the extraction with the accuracy corrected is performed. The robot 5 can be accurately operated based on the difference position teaching data. Therefore, in this embodiment, each of the four batteries 3 mounted on the bus 2 can be appropriately replaced even if the robot 5 does not have the docking arm included in the battery exchange device described in Patent Document 1. become. That is, in this embodiment, even if the configuration of the robot 5 is simple, each of the four batteries 3 mounted on the bus 2 can be appropriately replaced.

また、本形態では、交換されるバッテリー3が搭載されるバッテリー置き台6に形成される検出用マーク8の検出後に、バッテリー3の交換動作に移ることができるため、バッテリー3の交換時間を短縮することが可能になる。また、本形態では、交換されるバッテリー3を指定するバッテリー指定信号を外部装置から制御部91が受け取ると、指定されたバッテリー3が搭載されるバッテリー置き台6に形成される検出用マーク8について計算された修正検出用マーク位置データと、指定されたバッテリー3が搭載されるバッテリー置き台6に形成される検出用マーク8に関するバッテリー検出位置の校正データと、指定されたバッテリー3の引抜きおよび差込みを行うための抜差位置教示データとが自動的に読み出されるため、バッテリー3を交換する際に、外部装置とロボット5との間のデータの通信を簡素化することが可能になる。   Further, in this embodiment, the battery 3 can be replaced after the detection mark 8 formed on the battery mount 6 on which the battery 3 to be replaced is mounted, so that the battery 3 replacement time is shortened. It becomes possible to do. Further, in this embodiment, when the control unit 91 receives a battery designation signal designating the battery 3 to be replaced from the external device, the detection mark 8 formed on the battery mount 6 on which the designated battery 3 is mounted. The calculated correction detection mark position data, the calibration data of the battery detection position related to the detection mark 8 formed on the battery mount 6 on which the specified battery 3 is mounted, and the extraction and insertion of the specified battery 3 Therefore, when the battery 3 is replaced, data communication between the external device and the robot 5 can be simplified.

本形態では、バッテリー3を交換する際に、指定されたバッテリー3が搭載されるバッテリー置き台6に形成される検出用マーク8に関するバッテリー検出位置の校正データを読み出し、指定されたバッテリー3が搭載されるバッテリー置き台6の検出用マーク8の実際の位置の検出結果と読み出された校正データとに基づいて、指定されたバッテリー3の引抜きおよび差込みを行うための抜差位置教示データを補正している。そのため、本形態では、交換されるバッテリー3の抜差位置教示データをより精度良く補正することが可能になる。   In this embodiment, when the battery 3 is replaced, the calibration data of the battery detection position relating to the detection mark 8 formed on the battery mount 6 on which the designated battery 3 is mounted is read, and the designated battery 3 is installed. Based on the detection result of the actual position of the detection mark 8 of the battery cradle 6 to be read and the read calibration data, the insertion / removal position teaching data for extracting and inserting the designated battery 3 is corrected. doing. Therefore, in this embodiment, it is possible to correct the insertion / extraction position teaching data of the battery 3 to be replaced with higher accuracy.

(他の実施の形態)
上述した形態は、本発明の好適な形態の一例ではあるが、これに限定されるものではなく本発明の要旨を変更しない範囲において種々変形実施が可能である。
(Other embodiments)
The above-described embodiment is an example of a preferred embodiment of the present invention, but is not limited to this, and various modifications can be made without departing from the scope of the present invention.

上述した形態では、検出用マーク8は、バッテリー置き台6の前面から突出する平板状に形成されている。この他にもたとえば、検出用マーク8は、バッテリー置き台6の前面から窪む凹部であっても良い。たとえば、図32に示すように、バッテリー置き台6の前壁を貫通する略正三角形状の貫通孔6aと、貫通孔6aを塞ぐようにバッテリー置き台6の前壁の後面に固定される反射板110とによって、検出用マーク8が形成されても良い。この場合には、バッテリー置き台6の製作時に、プレスによる抜き加工でバッテリー置き台6の前壁に貫通孔6aを形成することが可能になるため、平板状に形成される検出用マーク8をバッテリー置き台6の前面に固定する場合と比較して、検出用マーク8の位置精度を高めることが可能になる。   In the embodiment described above, the detection mark 8 is formed in a flat plate shape protruding from the front surface of the battery mount 6. In addition to this, for example, the detection mark 8 may be a recess recessed from the front surface of the battery mount 6. For example, as shown in FIG. 32, a substantially equilateral triangular through hole 6a penetrating the front wall of the battery cradle 6 and a reflection fixed to the rear surface of the front wall of the battery cradle 6 so as to close the through hole 6a. The detection mark 8 may be formed by the plate 110. In this case, since the through hole 6a can be formed in the front wall of the battery cradle 6 by a punching process when the battery cradle 6 is manufactured, the detection mark 8 formed in a flat plate shape is provided. Compared with the case of fixing to the front surface of the battery mount 6, the positional accuracy of the detection mark 8 can be increased.

上述した形態では、検出機構21は、レーザセンサであるが、検出機構21は、レーザセンサでなくても良い。たとえば、検出機構21は、カメラであっても良い。この場合には、バッテリー3と検出機構21との距離は、検出機構21(すなわち、カメラ)の被写界深度を利用して検出すれば良い。また、検出機構21は、超音波センサと、レーザセンサまたはカメラとの組合せであっても良い。この場合には、超音波センサによって、バッテリー3の前後方向の位置が検出され、レーザセンサまたはカメラによって、バッテリー3の上下左右方向の位置が検出される。   In the embodiment described above, the detection mechanism 21 is a laser sensor, but the detection mechanism 21 may not be a laser sensor. For example, the detection mechanism 21 may be a camera. In this case, the distance between the battery 3 and the detection mechanism 21 may be detected using the depth of field of the detection mechanism 21 (that is, the camera). The detection mechanism 21 may be a combination of an ultrasonic sensor and a laser sensor or a camera. In this case, the position of the battery 3 in the longitudinal direction is detected by the ultrasonic sensor, and the position of the battery 3 in the vertical and horizontal directions is detected by the laser sensor or the camera.

上述した形態では、検出用マーク8は、上下方向でその幅が変化する略三角形状に形成されているが、検出用マーク8は、上下方向でその幅が変化する略台形状に形成されても良い。また、検出用マーク8は、円形状に形成されても良い。検出用マーク8が円形状に形成される場合には、検出機構21が左右方向および上下方向で検出用マーク8を横切るようにバッテリー搭載部22を移動させて、検出用マーク8の中心位置を検出することで、バッテリー3の上下左右方向の位置を検出すれば良い。また、この場合には、たとえば、検出用マーク8の中心位置と検出機構21との距離からバッテリー3の前後方向の位置を検出すれば良い。   In the embodiment described above, the detection mark 8 is formed in a substantially triangular shape whose width changes in the vertical direction, but the detection mark 8 is formed in a substantially trapezoidal shape whose width changes in the vertical direction. Also good. The detection mark 8 may be formed in a circular shape. When the detection mark 8 is formed in a circular shape, the detection mechanism 21 moves the battery mounting portion 22 so as to cross the detection mark 8 in the left-right direction and the vertical direction, so that the center position of the detection mark 8 is set. By detecting, the position of the battery 3 in the vertical and horizontal directions may be detected. In this case, for example, the position of the battery 3 in the front-rear direction may be detected from the distance between the center position of the detection mark 8 and the detection mechanism 21.

上述した形態では、検出機構21は、バッテリー搭載部22に取り付けられているが、検出機構21は、バッテリー係合部24に取り付けられても良い。また、上述した形態では、ロボット5は、バス2に搭載されるバッテリー3を交換するためのロボットであるが、ロボット5は、トラックや自家用車等のバス2以外の車両のバッテリー3を交換するためのロボットであっても良い。   In the embodiment described above, the detection mechanism 21 is attached to the battery mounting portion 22, but the detection mechanism 21 may be attached to the battery engagement portion 24. In the above-described embodiment, the robot 5 is a robot for replacing the battery 3 mounted on the bus 2. However, the robot 5 replaces the battery 3 of a vehicle other than the bus 2 such as a truck or a private car. It may be a robot for.

2 バス(車両)
3 バッテリー
5 ロボット(バッテリー交換ロボット)
6 バッテリー置き台
8 検出用マーク
17 バッテリー抜差機構
21 検出機構
91 制御部
2 Bus (vehicle)
3 Battery 5 Robot (Battery exchange robot)
6 Battery stand 8 Detection mark 17 Battery insertion / removal mechanism 21 Detection mechanism 91 Control unit

Claims (6)

車両に搭載されている複数のバッテリーを交換するためのバッテリー交換ロボットであって、
前記車両からの複数の前記バッテリーのそれぞれの引抜きおよび/または前記車両への複数の前記バッテリーのそれぞれの差込みを行うバッテリー抜差機構と、前記車両に取り付けられるとともに複数の前記バッテリーのそれぞれが搭載される複数のバッテリー置き台のそれぞれに形成される複数の検出用マークのそれぞれを検出するための検出機構と、前記バッテリー交換ロボットを制御する制御部とを備え、
前記制御部は、前記バッテリー抜差機構による複数の前記バッテリーのそれぞれの引抜きおよび/または差込みを行うために所定の基準位置に停止する前記車両を用いて前記バッテリー交換ロボットに教示された抜差位置の教示データである抜差位置教示データと、前記バッテリーが実際に交換される前記車両の複数の前記検出用マークのそれぞれの検出を前記検出機構によって行うときの基準となる検出用位置のデータである検出用位置データとを記憶するとともに、
複数の前記バッテリーのうちの交換対象となる1つの前記バッテリーを第1バッテリーとし、前記第1バッテリーの引抜きおよび/または差込みを行うための前記抜差位置教示データを第1抜差位置教示データとし、複数の前記検出用マークのうちの前記第1バッテリーが搭載される前記バッテリー置き台に形成される前記検出用マークを第1検出用マークとし、前記第1検出用マークの検出を行うときの前記検出用位置データを第1検出用位置データとすると、
前記制御部は、前記バッテリーが実際に交換される前記車両に対する前記第1バッテリーの抜差し時に、前記第1検出用位置データを前記第1バッテリーの交換用のデータとして読み出し、前記第1検出用位置データを基準にして前記バッテリー交換ロボットを動作させて前記第1検出用マークの検出を行うとともに、前記第1検出用マークの検出結果に基づいて、前記第1抜差位置教示データを補正し、補正後の前記第1抜差位置教示データに基づいて前記バッテリー交換ロボットを動作させることを特徴とするバッテリー交換ロボット。
A battery exchange robot for exchanging a plurality of batteries mounted on a vehicle,
A battery pulling mechanism for pulling out each of the plurality of batteries from the vehicle and / or inserting each of the plurality of batteries into the vehicle, and each of the plurality of batteries mounted on the vehicle and mounted on the vehicle. A detection mechanism for detecting each of a plurality of detection marks formed on each of the plurality of battery mounts, and a control unit for controlling the battery replacement robot,
The control unit is provided with an insertion / removal position taught to the battery exchange robot by using the vehicle that stops at a predetermined reference position in order to pull out and / or insert a plurality of the batteries by the battery insertion / removal mechanism. And the detection position data serving as a reference when the detection mechanism detects each of the plurality of detection marks of the vehicle in which the battery is actually replaced. A certain position data for detection is memorized,
One of the plurality of batteries to be replaced is a first battery, and the insertion / removal position teaching data for pulling out and / or inserting the first battery is first extraction position teaching data. The detection mark formed on the battery mount on which the first battery is mounted among the plurality of detection marks is used as a first detection mark, and the first detection mark is detected. When the position data for detection is the first position data for detection,
The control unit reads out the first detection position data as replacement data for the first battery when the first battery is inserted into or removed from the vehicle in which the battery is actually replaced. The battery replacement robot is operated based on the data to detect the first detection mark, and based on the detection result of the first detection mark, the first insertion position teaching data is corrected, A battery exchanging robot characterized in that the battery exchanging robot is operated based on the corrected first draw position teaching data.
前記基準位置に停止する前記車両を用い前記検出機構によって実際に検出される前記車両の位置である車両基準位置と、前記バッテリーが実際に交換される前記車両の、前記検出機構によって検出される位置である車両実際位置との差を車両位置偏差とすると、
前記制御部は、複数の前記検出用マークのそれぞれの位置を検出するために前記基準位置に停止する前記車両を用い前記バッテリー交換ロボットに教示された検出用マーク教示位置と前記車両位置偏差とに基づいて、前記検出用位置を算出することを特徴とする請求項1記載のバッテリー交換ロボット。
The vehicle reference position, which is the position of the vehicle actually detected by the detection mechanism using the vehicle that stops at the reference position, and the position detected by the detection mechanism of the vehicle where the battery is actually replaced. When the difference from the actual vehicle position is the vehicle position deviation,
The control unit uses the vehicle that stops at the reference position to detect the position of each of the plurality of detection marks, and detects the detection mark teaching position taught to the battery replacement robot and the vehicle position deviation. The battery replacement robot according to claim 1, wherein the detection position is calculated based on the battery position.
前記制御部は、前記基準位置に停止する前記車両を用い前記検出機構によって実際に検出される前記検出用マークの位置である検出用マーク基準位置のデータである検出用マーク基準位置データを記憶するとともに、
前記検出機構によって検出される前記第1検出用マークの位置である前記検出用マーク基準位置としての第1検出用マーク基準位置のデータを第1検出用マーク基準位置データとすると、
前記制御部は、前記バッテリーが実際に交換される前記車両に対する前記第1バッテリーの抜差し時に、前記第1検出用マーク基準位置データを前記第1バッテリーの交換用のデータとして読み出して、前記第1検出用マークの検出結果と前記第1検出用マーク基準位置データとに基づいて前記第1抜差位置教示データを補正することを特徴とする請求項1または2記載のバッテリー交換ロボット。
The control unit stores detection mark reference position data that is data of a detection mark reference position that is a position of the detection mark that is actually detected by the detection mechanism using the vehicle that stops at the reference position. With
If the first detection mark reference position data is the first detection mark reference position data as the detection mark reference position, which is the position of the first detection mark detected by the detection mechanism,
The control unit reads the first detection mark reference position data as the replacement data for the first battery when the first battery is inserted into and removed from the vehicle in which the battery is actually replaced. 3. The battery replacement robot according to claim 1, wherein the first insertion / extraction position teaching data is corrected based on a detection result of a detection mark and the first detection mark reference position data.
前記バッテリーが実際に交換される前記車両の前記第1検出用マークの、前記検出機構によって検出される位置である第1検出用マーク実際位置と前記第1検出用マーク基準位置との差を第1検出用マーク位置偏差とすると、
前記制御部は、前記第1バッテリーの引抜きおよび/または差込みを行うための前記抜差位置である第1抜差位置を前記第1検出用マーク位置偏差に基づいて補正した第1補正位置を算出して前記第1抜差位置教示データを補正することを特徴とする請求項3記載のバッテリー交換ロボット。
The difference between the first detection mark actual position, which is the position detected by the detection mechanism, and the first detection mark reference position of the first detection mark of the vehicle where the battery is actually replaced is Assuming 1 detection mark position deviation,
The control unit calculates a first correction position obtained by correcting the first extraction position, which is the extraction position for extracting and / or inserting the first battery, based on the first detection mark position deviation. The battery replacement robot according to claim 3, wherein the first drawing position teaching data is corrected.
車両に搭載されている複数のバッテリーのそれぞれの引抜きおよび/または前記車両への複数の前記バッテリーのそれぞれの差込みを行うバッテリー抜差機構と、前記車両に取り付けられるとともに複数の前記バッテリーのそれぞれが搭載される複数のバッテリー置き台のそれぞれに形成される複数の検出用マークのそれぞれを検出するための検出機構とを備え、前記車両に搭載されている前記バッテリーを交換するバッテリー交換ロボットの制御方法であって、
前記バッテリー抜差機構による複数の前記バッテリーのそれぞれの引抜きおよび/または差込みを行うために所定の基準位置に停止する前記車両を用いて前記バッテリー交換ロボットに教示された抜差位置の教示データである抜差位置教示データと、前記バッテリーが実際に交換される前記車両の複数の前記検出用マークのそれぞれの検出を前記検出機構によって行うときの基準となる検出用位置のデータである検出用位置データとを記憶するとともに、
複数の前記バッテリーのうちの交換対象となる1つの前記バッテリーを第1バッテリーとし、前記第1バッテリーの引抜きおよび/または差込みを行うための前記抜差位置教示データを第1抜差位置教示データとし、複数の前記検出用マークのうちの前記第1バッテリーが搭載される前記バッテリー置き台に形成される前記検出用マークを第1検出用マークとし、前記第1検出用マークの検出を行うときの前記検出用位置データを第1検出用位置データとすると、
前記バッテリーが実際に交換される前記車両に対する前記第1バッテリーの抜差し時に、前記第1検出用位置データを前記第1バッテリーの交換用のデータとして読み出し、前記第1検出用位置データを基準にして前記バッテリー交換ロボットを動作させて前記第1検出用マークの検出を行うとともに、前記第1検出用マークの検出結果に基づいて、前記第1抜差位置教示データを補正し、補正後の前記第1抜差位置教示データに基づいて前記バッテリー交換ロボットを動作させることを特徴とするバッテリー交換ロボットの制御方法。
A battery pulling mechanism for pulling out each of a plurality of batteries mounted on the vehicle and / or inserting each of the plurality of batteries into the vehicle, and each of the plurality of batteries mounted on the vehicle and mounted on the vehicle A detection mechanism for detecting each of a plurality of detection marks formed on each of the plurality of battery mounts, and a control method of a battery exchange robot for exchanging the battery mounted on the vehicle There,
It is teaching data of the insertion / removal position taught to the battery replacement robot using the vehicle that stops at a predetermined reference position in order to pull out and / or insert each of the plurality of batteries by the battery insertion / removal mechanism. Detection position data which is a reference position when the detection mechanism detects each of the plurality of detection marks of the vehicle where the battery is actually replaced. And remember
One of the plurality of batteries to be replaced is a first battery, and the insertion / removal position teaching data for pulling out and / or inserting the first battery is first extraction position teaching data. The detection mark formed on the battery mount on which the first battery is mounted among the plurality of detection marks is used as a first detection mark, and the first detection mark is detected. When the position data for detection is the first position data for detection,
The first detection position data is read as replacement data for the first battery when the first battery is inserted into or removed from the vehicle in which the battery is actually replaced, and the first detection position data is used as a reference. The battery replacement robot is operated to detect the first detection mark, and based on the detection result of the first detection mark, the first insertion position teaching data is corrected, and the corrected first 1. A control method for a battery exchange robot, wherein the battery exchange robot is operated based on one plug position teaching data.
前記基準位置に停止する前記車両を用い前記検出機構によって実際に検出される前記検出用マークの位置である検出用マーク基準位置のデータである検出用マーク基準位置データを記憶するとともに、
前記検出機構によって実際に検出される前記第1検出用マークの位置である前記検出用マーク基準位置としての第1検出用マーク基準位置のデータを第1検出用マーク基準位置データとすると、
前記バッテリーが実際に交換される前記車両に対する前記第1バッテリーの抜差し時に、前記第1検出用マーク基準位置データを前記第1バッテリーの交換用のデータとして読み出して、前記第1検出用マークの検出結果と前記第1検出用マーク基準位置データとに基づいて前記第1抜差位置教示データを補正することを特徴とする請求項5記載のバッテリー交換ロボットの制御方法。
Storing detection mark reference position data that is data of a detection mark reference position that is a position of the detection mark that is actually detected by the detection mechanism using the vehicle that stops at the reference position;
When the data of the first detection mark reference position as the detection mark reference position, which is the position of the first detection mark actually detected by the detection mechanism, is the first detection mark reference position data,
When the first battery is inserted into or removed from the vehicle where the battery is actually replaced, the first detection mark reference position data is read as replacement data for the first battery to detect the first detection mark. 6. The method for controlling a battery exchange robot according to claim 5, wherein the first insertion position teaching data is corrected based on the result and the first detection mark reference position data.
JP2012170925A 2012-08-01 2012-08-01 Battery exchange robot and control method of battery exchange robot Expired - Fee Related JP6050983B2 (en)

Priority Applications (4)

Application Number Priority Date Filing Date Title
JP2012170925A JP6050983B2 (en) 2012-08-01 2012-08-01 Battery exchange robot and control method of battery exchange robot
CN201380011825.7A CN104136286B (en) 2012-08-01 2013-07-24 The reminding method of battery altering robot and battery altering robot
KR1020147025808A KR101595684B1 (en) 2012-08-01 2013-07-24 Method for teaching battery-replacing robot, and battery-replacing robot
PCT/JP2013/069966 WO2014021148A1 (en) 2012-08-01 2013-07-24 Method for instructing battery-replacing robot, and battery-replacing robot

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2012170925A JP6050983B2 (en) 2012-08-01 2012-08-01 Battery exchange robot and control method of battery exchange robot

Publications (2)

Publication Number Publication Date
JP2014031031A JP2014031031A (en) 2014-02-20
JP6050983B2 true JP6050983B2 (en) 2016-12-21

Family

ID=50281227

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2012170925A Expired - Fee Related JP6050983B2 (en) 2012-08-01 2012-08-01 Battery exchange robot and control method of battery exchange robot

Country Status (1)

Country Link
JP (1) JP6050983B2 (en)

Families Citing this family (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2019129295A1 (en) * 2017-12-29 2019-07-04 上海电巴新能源科技有限公司 Battery change positioning control system, battery change device, and battery disassembly and assembly method
KR102063906B1 (en) * 2019-07-17 2020-02-11 이엠티씨 주식회사 Battery replacement device for track vehicles and charging station system having same
CN112046314A (en) * 2020-09-01 2020-12-08 邹萍 Lithium battery box, electric automobile and cabinet equipment that charges
CN113650523A (en) * 2021-08-10 2021-11-16 东风柳州汽车有限公司 Battery replacement control method, device, equipment and storage medium
CN113635769B (en) * 2021-10-14 2021-12-21 徐州大工电子科技有限公司 New energy automobile safety protection system
CN113696778B (en) * 2021-10-29 2022-01-18 江苏索尔新能源科技股份有限公司 Battery turnover adjusting device for battery changing station
CN117355975A (en) * 2022-03-08 2024-01-05 时代电服科技有限公司 Battery replacement method, device, control equipment and battery replacement station

Family Cites Families (10)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP3134909B2 (en) * 1993-08-26 2001-02-13 株式会社タツノ・メカトロニクス Battery replacement device for electric vehicles
JP4081266B2 (en) * 2001-12-07 2008-04-23 株式会社テムザック Battery changer
CN1261319C (en) * 2004-11-11 2006-06-28 北京电巴科技有限公司 Electric public transport system
US20080294283A1 (en) * 2007-05-25 2008-11-27 Ronald Ligrano Battery exchange station and a method of changing therein
CN201530303U (en) * 2009-08-10 2010-07-21 北京理工大学 Power battery box mechanism of electric motor coach and battery box replacement system thereof
CN102040010B (en) * 2010-09-30 2014-07-23 国家电网公司 Battery changing device for commercial electric vehicle and electric conversion system
FR2970224B1 (en) * 2011-01-06 2013-01-04 Yves Quemeneur REMOVABLE CONTAINER EXCHANGE DEVICE FOR ELECTRIC VEHICLE ELECTRIC BATTERY, ASSOCIATED REMOVABLE CONTAINER AND REMOVABLE CONTAINER EXCHANGE STATION THEREFOR
CN102152776B (en) * 2011-03-07 2013-10-09 国电南瑞科技股份有限公司 Battery replacing system and battery replacing method of electromobile battery replacing station
CN102259639A (en) * 2011-03-07 2011-11-30 北京理工大学 Mobile integrated vehicle-mounted dynamic battery fast-replacing system
CN102180143B (en) * 2011-04-12 2013-01-30 南京艾鸿科技有限公司 Battery replacing method, battery replacing system and battery rack of electric vehicle

Also Published As

Publication number Publication date
JP2014031031A (en) 2014-02-20

Similar Documents

Publication Publication Date Title
JP6050983B2 (en) Battery exchange robot and control method of battery exchange robot
JP6050984B2 (en) Battery exchange robot and battery exchange system
WO2014021148A1 (en) Method for instructing battery-replacing robot, and battery-replacing robot
JP6050982B2 (en) Battery exchange robot teaching method and battery exchange robot
JP6027808B2 (en) Battery exchange system and method for controlling battery exchange system
JP5955784B2 (en) Battery replacement robot
WO2012105530A1 (en) Battery-replacing robot and battery-replacement system
WO2015045981A1 (en) Battery replacing robot, battery replacing system, and battery replacing robot control method
JP6596416B2 (en) Method and apparatus for battery replacement in a vehicle
JP6181494B2 (en) Battery exchange robot, battery exchange system, and battery exchange robot control method
JP5897924B2 (en) Battery replacement robot
KR101898633B1 (en) Gripper of transfer apparatus for semiconductor wafer
WO2022143696A1 (en) Apparatus assembly system and method
JP5884507B2 (en) How to learn goods storage facilities
JP2017147868A (en) Charging device and traveling device charging system
JP6317085B2 (en) Battery exchange robot, battery exchange system, and battery exchange robot control method
CN207170287U (en) A kind of battery automatic detection device
JP2011025819A (en) Battery changer for vehicle
JP5848267B2 (en) Battery replacement robot
JP5379199B2 (en) Roll body transport device
KR102461029B1 (en) Material handling system and method
CN220282840U (en) Workpiece positioning device and battery production line
CN215177544U (en) Semiconductor single crystal silicon rod equal diameter length measuring device
JP5728294B2 (en) Multi-axis head transport device
JP2020105009A (en) Alignment mechanism of taken-up web conveying device

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20150706

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20160506

TRDD Decision of grant or rejection written
A01 Written decision to grant a patent or to grant a registration (utility model)

Free format text: JAPANESE INTERMEDIATE CODE: A01

Effective date: 20161108

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20161128

R150 Certificate of patent or registration of utility model

Ref document number: 6050983

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150

LAPS Cancellation because of no payment of annual fees