六自由度机械手的坐标建立及运动学分析_百度文库
两大类热门资源免费畅读
续费一年阅读会员，立省24元！
六自由度机械手的坐标建立及运动学分析
上传于||暂无简介
阅读已结束，如果下载本文需要使用1下载券
想免费下载本文？
定制HR最喜欢的简历
下载文档到电脑，查找使用更方便
还剩1页未读，继续阅读
定制HR最喜欢的简历
你可能喜欢机械手位置检测装置以及机械手系统的制作方法
专利名称机械手位置检测装置以及机械手系统的制作方法
机械手位置检测装置以及机械手系统技术区域本发明涉及一种检测机械手位置的机械手位置检测装置以及具备该机械手位置检测装置的机械手系统。
背景技术以往，作为对把持工件的机械手的目标位置进行修正的方法，已知有一种例如像专利文献I那样的技术。在专利文献I中，为了将机械手所把持的工件和设置于该机械手的基准标记配置到对工件进行拍摄的摄像装置的摄像范围内，使摄像装置以及机械手分别移动至规定的位置。而且，通过对由摄像装置拍摄到的图像进行图像处理，取得工件相对基准标记的中心坐标和倾斜度等，基于该取得的中心坐标等算出与机械手的目标位置相关的位置修正量。 专利文献I :日本专利第4539685号公报不过，在专利文献I的方法中，虽然能够准确算出与机械手的目标位置相关的位置修正量，但在对用于算出位置修正量的图像进行拍摄时需要停止机械手。虽说是为了算出位置修正量，但若将机械手停止在规定的位置，则与其停止的时间量对应地装置的生产效率降低。为了抑制这种生产效率的降低，希望不停止机械手地对移动中的工件进行拍摄，基于该拍摄时的机械手的位置和拍摄后的工件的图像取得机械手的位置修正量。另一方面，表示机械手的位置的来自编码器的数据通常通过串行通信被输入到机械手控制器。因此，与该数据被输出的定时相比，在滞后了与串行通信的通信周期以及数据量等对应的、编码器和机械手控制器之间的通信时间的定时，被输入到机械手控制器。此时，若像上述那样机械手不断地移动，则基于编码器算出的位置和从图像得到的位置在时间轴上相互不同。
本发明是鉴于上述的实际状况而完成的发明，其目的在于，提供一种针对从移动中的机械手检测到的该机械手的位置，可提高其精度的机械手位置检测装置以及机械手系统。本发明的机械手位置检测装置具有位置数据输入部，其被从编码器输入表示机械手的位置的位置数据；和位置算出部，其取得上述被输入的位置数据，算出机械手的位置；上述位置算出部接受用于检测上述机械手的位置的指令，使用在上述指令之前的第I定时取得的第I位置数据、在上述指令之后的第2定时取得的第2位置数据、和上述编码器与上述位置数据输入部之间的通信所需的通信时间，通过上述第I位置数据和上述第2位置数据的线性插值，算出与被输入上述指令的定时相比滞后上述通信时间的定时的位置，并将该算出结果作为被输入上述指令时的上述机械手位置而输出。根据该机械手位置检测装置，由于基于与指令被输入的定时相比滞后了编码器和位置数据输入部之间的通信所需要的通信时间的定时，利用线性插值输出机械手的位置，所以线性插值所使用的各数据的定时成为大致相等的时间轴上的定时。因此，通过使用第I位置数据和第2位置数据的线性插值而算出的机械手的位置，成为以通信时间修正机械手移动的移动量后的位置。因此，能够更高精度地检测移动中的机械手的位置。在该机械手位置检测装置中，上述位置算出部具备指令检测部，该指令检测部能够以比取得从一个编码器输入给上述位置输入部的上述位置数据的规定周期T短的周期Ts检测该指令。根据该机械手位置检测装置，与被从一个编码器输入位置数据的定时相比，可检测指令的定时变多。结果，能够检测出与被输入指令的定时更接近的时期的机械手的位置。在该机械手位置检测装置中，上述位置算出部按照每个周期T/n，取得来自相互 不同的编码器的位置数据，按照每个上述编码器输出被输入上述指令时的上述机械手的位置，所述周期T/n是将上述规定的周期T以I以上的整数n进行n等分而得到的周期。根据该机械手位置检测装置，由于按照相互不同的编码器算出机械手的位置，所以能够以更高的精度检测指令被输入时的机械手的位置。在该机械手位置检测装置中，上述位置算出部对取得的上述位置数据是否正常进行判断，并且在判断为检测到上述指令时的前一上述位置数据不正常的情况下，将在该位置数据之前取得的前一位置数据作为上述第I位置数据使用。由于从编码器输入的位置数据是电信号，所以存在例如受到噪音等的影响的问题。若使用这样的受到影响的位置数据算出机械手的位置，则由位置算出部算出的机械手的位置的可靠性降低。在这一点上，根据上述结构的机械手位置检测装置，由于位置算出部对取得的位置数据是否正常进行判断，并且在判断为检测到指令时的前一位置数据不正常的情况下，将在该位置数据之前取得的前一位置数据作为第I位置数据使用，所以，能够使用正常的位置数据来算出机械手的位置。在该机械手位置检测装置中，上述位置算出部在判断为紧接着检测到上述指令后取得的上述位置数据不正常的情况下，将在紧接着该位置数据之后取得的位置数据作为上述第2位置数据使用。通常，第I定时和第2定时间隔越长，越会失去相互之间的位置的线性。在该机械手位置检测装置中，由于使用这样的线性插值，所以，第I定时和第2定时在时间上间隔越长，由位置算出部算出的机械手的位置和实际的机械手的位置越容易产生大的误差。在这一点上，根据上述结构，例如当将输入位置数据的定时、即检测到指令后的定时作为基准定时时，即便是第I定时和第2定时在时间上间隔最长的情况，第I位置数据也是在比基准定时提前2个定时输入的位置数据。第2位置数据是在比基准定时滞后2个定时输入的位置数据。结果，与基于在该第I定时之前取得的位置数据和在该第2定时之后取得的位置数据算出机械手的位置的情况相比，能够提高算出的机械手的位置精度。本发明的机械手系统具备搬运工件的机械手；编码器，其输出表示上述机械手位置的位置数据；指令输出部，其输出用于检测上述机械手的位置的指令；和机械手位置检测部，其被输入上述位置数据和上述指令，基于上述位置数据检测被输入上述指令时的上述机械手的位置；上述机械手位置检测部是上述的机械手位置检测装置。根据本发明的机械手系统，即便在机械手移动中指令输出部输出了指令，也能够高精度地检测该机械手的位置。
该机械手系统还具备照相机，其通过在被输入来自上述指令输出部的指令的定时，对预定的拍摄范围进行拍摄，来取得包含向目标位置移动过程中的上述机械手所搬运的工件的图像；工件位置取得部，其基于上述照相机取得的图像，取得上述工件的位置；以及目标位置修正部，其基于上述工件位置取得部取得的上述工件的位置、和上述机械手位置检测部检测到的上述机械手的位置，对上述目标位置进行修正。根据该机械手系统，能够基于被输入来自指令输出部的指令的定时的机械手的位置与工件的位置的相对位置，对机械手的目标位置进行修正。如上所述，由机械手位置检测部检测的机械手的位置是使机械手移动并对其进行检测的位置，并且其精度提高。即，无需为了修正目标位置而停止机械手，并且，针对机械手的目标位置的修正量的精度也能够提高。结果，能够在抑制机械手系统的生产效率降低的同时，将工件搬运到应该搬运的位置。图I是表示本发明的一个实施方式所涉及的机械手系统的概要结构的立体图。图2是表示机械手的正面结构的主视图。
图3是表示机械手系统的系统结构的功能框图。图4是表示取得各编码器的位置数据的定时的时序图。图5是表示数据处理部的存储部所存储的数据的图。图6是使机械手的位置与时间对应的图，是用于概念性说明算出机械手的位置的计算过程的说明图。图7是表示算出机械手位置的处理步骤的流程图。图8是表示算出机械手位置的处理步骤的流程图。
具体实施例方式下面，参照图I 图8，对本发明所涉及的机械手位置检测装置以及机械手系统的一个实施方式进行说明。首先，参照图I及图2对本发明所涉及的机械手系统的概要结构进行说明。如图I所示，机械手系统10中在以规定的搬运速度沿搬运方向Cv搬运工件W的传送带11的侧方，配置有对被传送带11搬运的工件W进行选择性地把持、对其进行规定作业的水平多关节型机械手12。在搬运方向Cv的机械手12的上游侧，设置有从上方对在传送带11上被搬运的工件W进行拍摄的照相机13。在该机械手系统10中，基于由照相机13拍摄到的图像来选择成为作业对象的工件W，并基于该图像和测定传送带11的搬运量的编码器14，对被选择为作业对象的工作W的位置进行把握。被选择为作业对象的工件W在通过机械手12而上升到规定高度的状态下，被搬运到设置于该机械手12的可动范围内的作业台15上的规定位置。如图2所示，机械手12中在设置于地面等的基台21的上端部设置有以沿垂直方向的控制轴Cl为中心相对基台21可转动的基台轴22。通过设置于基台21内的第I马达23正反旋转，基台轴22以控制轴Cl为中心转动。在基台轴22上连结固定有沿水平方向延伸的第I水平臂24的基端部。在第I水平臂24的前端部上连结固定有支承轴25。支承轴25支承第2水平臂26，该第2水平臂26以沿垂直方向的控制轴C2为中心相对支承轴25可转动。在第2水平臂26的基端部配设有第2马达27。第2水平臂26借助因第2马达27正反旋转而使该第2马达27从支承轴25受到的反作用力，以控制轴C2为中心相对第I水平臂24在水平方向转动。
在第2水平臂26的前端部设置有贯通第2水平臂26的上下旋转轴29。上下旋转轴29被支承为可相对第2水平臂26旋转，且可在上下方向移动。而且，上下旋转轴29通过第2水平臂26所具备的升降马达30正反旋转，沿垂直方向的控制轴C3升降。上下旋转轴29通过第2水平臂26所具备的旋转马达31正反旋转，以沿垂直方向的自身的控制轴C4为中心正反旋转。能够在上下旋转轴29的作业部32上安装工具，例如把持被搬运物的手、加工被加工物的手等。另外，在向作业台15搬运的工件W的搬运路径上，设置有检测工件W通过了检测线FL的检测传感器35。检测传感器35具备沿水平方向射出由指向性、收敛性高的激光构成的检测光LB的射出部36和接受由射出部36射出的检测光LB的受光部37。射出部36及受光部37被设置成隔着机械手12的可动范围，且检测光LB暂时被从传送带11向作业台15搬运的工件W遮挡。在检测传感器35的下侧设置有与检测传感器35检测工件W同步地从下方对该工件W进行拍摄的照相机39。在该机械手系统10中，基于由该照相机39拍摄到的图像和此时机械手12的位置，把握工件W相对机械手12的相对位置，来对机械手12的目标位置进行修正，以使工件W被搬运至预先设定的位置。下面，参照图3 图8对上述结构的机械手系统10的系统结构进行说明。如图3所示，上述的机械手系统10通过控制器50被统一控制。控制器50是驱动控制机械手12的控制装置，对机械手12向目标位置移动的定位动作进行控制，或对机械手12追随在传送带11上移动的工件W的追随动作进行控制。在控制器50中预先设定有表示机械手12的结构、动作特性以及可动范围内的区域即能够追随传送带11上的工件W的追随区域等的机械手数据。而且，设定有表示传送带11和机械手12的相对位置、传送带11和照相机39的相对位置及机械手12和照相机39的相对位置等的与各种位置相关的数据；以及表示工件种类和形状的工件数据等。并且，这些机械手数据、与各种位置相关的数据以及工件数据被用于机械手12的驱动控制。控制器50具备存储用户程序的用户程序存储部51、和执行存储在该用户程序存储部51的用户程序的用户程序执行部52。而且具备收纳由照相机13识别出的工件W的初始位置的工件位置存储部53、和基于传送带11的移动量算出该工件位置存储部53的工件W的当前位置的工件位置更新部54。并且，具备生成作业部32的轨道(各控制轴Cl C4的关节角度)，并将其变换成马达指令值(脉冲)，输出给后述的马达控制部57的指令值生成部55。另外，还具备根据追随区域和工件W的位置关系等检测成为作业对象的工件W的作业对象检测部56、和根据来自指令值生成部55的马达指令值对各控制轴Cl C4的马达23、27、30、31进行控制的马达控制部57。用户程序存储部51的用户程序是执行为了使机械手12的作业部32移动来追随作业对象的工件W所必要的各种处理的程序。而且，是执行为了使作业部32所把持的工件W移动到作业台15的规定位置所必要的各种处理的程序。用户程序执行部52执行用户程序。用户程序执行部52根据作业对象检测部56的检测结果，将被检测为作业对象的工件W作为作业对象进行处理。并且，用户程序执行部52算出为了使机械手12追随被选择的工件W所必要的信息，而且算出为了使机械手12移动到目标位置所必要的信息，并将这些算出的数据传送给指令值生成部55。另外，从后述的工件位置取得部58向作为目标位置修正部的用户程序执行部52输入搬运中的工件W的位置，并且由位置算出部60算出的移动中的机械手12的位置被输入给用户程序执行部52。用户程序执行部52基于从工件位置取得部58输入的工件W的位置和从位置算出部60输入的机械手12的位置，对机械手12的目标位置进行修正，并且算出为了移动到该修正后的目标位置所必要的信息，并将该算出的数据传送给指令值生成部55。工件位置更新部54根据照相机13拍摄到的传送带11上的工件W的拍摄图像，求出工件W的初始位置，并将该初始位置的信息保存到工件位置存储部53。另一方面，工件位置更新部54基于由从编码器14输入的传送带脉冲的积算而得到的传送带脉冲数，算出通过传送带11传送的工件W的搬运量。然后，求出拍摄工件W时(初始位置)的传送带脉冲数和当前的传送带脉冲数之差，并利用该脉冲数的差与预先设定的单位传送带脉冲的搬运 量的乘积，求出相对工件W的初始位置的搬运量。工件位置更新部54例如通过对工件位置存储部53中存储的拍摄时算出的工件W的初始位置(X轴方向的坐标)加上如上所述算出的工件W的搬运量等，能够逐次计算在传送带11上搬运的工件W的当前位置。作业对象检测部56以规定的执行周期对工件W的当前位置和追随区域进行比较。然后，当工件W的当前位置到达(进入)追随区域内时，将该工件W检测为作业对象，并且，当该工件W的当前位置不包含在追随区域内时，不将该工件W检测为作业对象。然后，将检测到的结果传送给用户程序执行部52和指令值生成部55。指令值生成部55基于被输入的各种数据，生成用于使机械手12移动至目标位置的轨道，并且计算用于使机械手12追随该轨道的各控制轴Cl C4的关节角度。指令值生成部55将用于使机械手12沿着轨道的各控制轴Cl C4的关节角度作为目标关节角度输出给马达控制部57。在本实施方式中，马达控制部57以控制周期T控制I个马达，并且以不同的定时控制各个马达。本实施方式的马达控制部57以控制周期T除以控制轴数n(n为I以上的整数，在本实施方式中n = 4)得到的周期T/n，对各马达23、27、30、31依次进行控制，并且以周期T/n依次输出由指令值生成部55输出的与各马达的目标关节角度相应的输出。即，控制器50以周期T/n按照第I马达23、第2马达27、升降马达30、旋转马达31的顺序切换成为控制对象的马达。并且，控制器50具有工件位置取得部58，其取得由检测传感器35检测出工件W时的该工件W的位置；以及位置算出部60，其算出该检测时的机械手12的位置。工件位置取得部58通过对从照相机39输入的图像数据进行图像处理来取得工件W的位置数据，该照相机39从下方拍摄到达了检测线FL的工件W。工件位置取得部58通过上述图像处理，求出拍摄范围中的工件W的中心位置的坐标值，并输出给用户程序执行部52。照相机39与作为指令输出部的触发信号生成部59电连接，若从该触发信号生成部59被输入作为指令的触发信号，则在其摄像范围进行拍摄，并将其拍摄到的图像的图像数据输出给工件位置取得部58。若由检测传感器35检测到工件W，则触发信号生成部59生成作为指令的触发信号。触发信号生成部59将其生成的触发信号同时输出给照相机39和后述的触发信号输入部61。下面，对作为机械手位置检测装置以及机械手位置检测部的位置算出部60进行详细说明。如图3所示，位置算出部60具有作为指令检测部的触发信号输入部61、位置数据输入部62和数据处理部63。触发信号输入部61被输入触发信号生成部59所输出的触发信号。触发信号输入部61以触发信号的检测周期检测触发信号的状态，在数据处理部63中，以马达的控制周期T除以控制轴数n (在本实施方式中n = 4)而得到的检测周期Ts ( = T/n)检测触发信号输 入部61所检测到的触发信号的状态。位置数据输入部62与基于各马达23、27、30、31的绝对位置来检测各控制轴Cl、C2、C3、C4的关节角度的第I编码器64、第2编码器65、第3编码器66、第4编码器67连接。各编码器64 67每隔马达的控制周期T的一半时间(=T/2)、即编码器和位置数据输入部62之间的通信所需的通信时间Td，检测所对应的关节角度，并将其检测到的表示关节角度的位置数据输出给位置数据输入部62。另外，位置数据输入部62具有判定被输入的位置数据是否正常的判定部68。而且，位置数据输入部62使从各编码器64 67输入的位置数据与判定部68针对该位置数据的判定结果相对应。数据处理部63取得被输入给位置数据输入部62的位置数据和与该位置数据对应的判定结果。其中，如果数据处理部63从位置数据输入部62同时取得与各编码器对应的位置数据，则需要将数据处理部63构成为与各位置数据对应，存在数据处理部63的结构变复杂的问题。鉴于此，数据处理部63中内置有每隔周期T/n便加一的计数器，即表示与成为控制对象的控制轴对应的计数值的计数器。而且，如图4所示，数据处理部63每隔控制周期T便依次取得来自各编码器64 67的位置数据，以使该计数器的计数值所表示的控制轴、和与被输入到位置数据输入部62的位置数据对应的控制轴匹配。其中，来自编码器的位置数据通过通信时间Td的串行通信，被输入给位置数据输入部62。因此，数据处理部63所取得的位置数据是表示在比取得该位置数据的定时提前通信时间Td的定时，由编码器检测到的位置的位置数据。如图5所示，数据处理部63具有存储部70，该存储部70中预先设置有存储与控制轴Cl的关节角度、控制轴C2的关节角度、控制轴C3的关节角度、控制轴C4的关节角度相关的各种数据的区域。在本实施方式中，将来自编码器的位置数据被输入给位置数据输入部62的定时中、检测到触发信号的下一定时作为该编码器的基准定时。存储部70中按照控制轴Cl C4每一个设置有对比上述基准定时靠前取得的位置数据、即第I位置进行存储的区域。第I位置73a是被从第I编码器64输入的位置数据。第I位置73b是被从第2编码器65输入的位置数据。第I位置73c是被从第3编码器66输入的位置数据。第I位置73d是从被第4编码器67输入的位置数据。而且，存储器70中按照控制轴Cl C4每一个设置有对比上述基准定时靠后取得的位置数据、即第2位置进行存储的区域。第2位置74a是被从第I编码器64输入的位置数据。第2位置74b是被从第2编码器65输入的位置数据。第2位置74c是被从第3编码器66输入的位置数据。第2位置74d是被从第4编码器输入的位置数据。另外，在存储部70中按照控制轴Cl C4每一个设置有存储对于表示第I位置的位置数据，表示该位置数据是否正常的第I标志的区域。第I标志75a与被从第I编码器64输入的位置数据对应。第I标志75b与被从第2编码器65输入的位置数据对应。第I标志75c与被从第3编码器66输入的位置数据对应。第I标志75d与被从第4编码器67输入的位置数据对应。另外，在存储部70中按照控制轴Cl C4每一个设置有存储对于表示第2位置的位置数据，表示该位置数据是否正常的第2标志的区域。第2标志76a与被从第I编码器64输入的位置数据对应。第2标志76b与被从第2编码器65输入的位置数据对应。第2标志76c与和第3编码器66相关的位置数据对应。第2标志76d与被从第4编码器67输入的位置数据对应。 而且，数据处理部63每当取得位置数据时，便判断该位置数据是否正确。此时，若在比上述基准定时靠前的定时判断为位置数据正常，则数据处理部63将该位置数据更新为第I位置，且将第I标志设定为“O”。另一方面，若在比上述基准定时靠前的定时判断为位置数据异常，则数据处理部63不更新第I位置，将第I标志设定为“I”。其中，数据处理部63针对控制轴Cl C4依次执行上述的第I位置的更新以及第I标志的设定，直到检测到触发信号为止。然后，若检测到触发信号，则数据处理部63将该检测时的各第I位置以及第I标志作为第I定时数据77保存到存储部70的规定区域。另外，若在上述基准定时之后的定时判断为位置数据正常，则数据处理部63将该位置数据作为第2位置进行更新，并将第2标志设定为“O”。另一方面，若在上述基准定时之后的定时判断为位置数据异常，则数据处理部63不将该位置数据作为第2位置进行更新，将第2标志设定为“I”。然后，数据处理部63取得上述之后定时的下一定时的位置数据，无论该位置数据是否正常，都将该位置数据作为第2位置进行更新。而且，若所有的第2位置全部被更新，则数据处理部63将各第2位置以及第2标志作为第2定时数据78保存到存储部70的规定区域。另外，在存储部70中设置有对表示是否检测到触发信号的检测标志79进行存储的区域。若检测到触发信号，则数据处理部63将检测标志79设定为“ I ”，并且，若将算出的机械手12的位置输出给用户程序执行部52，则将检测标志79设定为“O”。另外，如图5所示，在存储部70中设置有对表示检测出触发信号时作为控制对象的控制轴的数据、即控制轴数据80进行存储的区域。数据处理部63基于内置的计数器的计数值，将表示检测出触发信号时的控制轴的数据保存为控制轴数据80。然后，每当检测到触发信号时，数据处理部63便基于上述第I定时数据77、第2定时数据78、控制轴数据80，算出检测出触发信号时的各控制轴Cl C4的关节角度，来检测机械手12的位置。下面，参照图6对位置算出部60计算机械手12的位置的算出方法进行说明。其中，在图6中将第I定时的关节角度、即第I位置表示为Pa，将第2定时的关节角度、即第2位置表示为Pb，将检测出触发信号时的关节角度表示为P (k)。而且，本实施方式中的通信时间Td为马达的控制周期T的一半的时间(T/2)。若第2定时数据78被保存，则数据处理部63按照控制轴Cl C4每一个基于第I标志与第2标志的组合，从根据该组合而预先设定的4个算式中选择I个算式。然后，通过将第I位置、第2位置和基于控制轴数据80的常数k代入到该选择的算式，求出检测出触发信号时的各控制轴Cl C4的关节角度。这里所说的常数k是基于成为算出对象的控制轴与检测出触发信号时成为控制对象的控制轴之间的关系，按每个控制轴决定的常数，以周期T/n为基准单位，是以“T/nXk”表示检测到触发信号的定时至基准定时为止的期间的常数。例如，在检测出触发信号时的控制对象为控制轴Cl (第I马达23)的情况下，如果算出对象是控制轴C2(第2马达27)，则由于比与第2编码器65相关的基准定时提前“周期T/n”检测到触发信号，所以常数k为“I”。另外，如果算出对象是控制轴C3(升降马达30)，则由于比第3编码器66的基准定时提前“2X周期T/n”检测到触发信号，所以常数k为“2”。另外，如果算出对象是控制轴C4(旋转马达31)，则由于比基准定时提前“3X周期T/n”检测到触发信号，所以常数k为“3”。另外，如果算出对象是控制轴Cl (第I马达23)，则由于比基准定时提前控制周期T检测到触发信号，所以常数k为“4”。在成为算出对象的控制轴的第I标志以及第2标志均为“0”的情况下，即在第I定时与基准定时间隔了“控制周期T”、基准定时与第2定时间隔了“控制周期T”的情况下， 数据处理部63利用以下所示的式(I)，算出检测出触发信号时的该控制轴的关节角度。式I
P Zj _ PnrTP⑷= Pa +-x(Td + Tk)
r n D Vb-Pa m 2k, Z1 \=Pa +-x(3--) ... (I)
4n另外，在成为算出对象的控制轴的第I标志为“0”、第2标志为“I”的情况下，即在第I定时与基准定时间隔了“控制周期T”、基准定时与第2定时间隔了“2X控制周期T”的情况下，数据处理部63利用以下所示的式(2)，算出检测出触发信号时的该控制轴的关节角度。式2
pA _ pnrTP(々) = Pa +-x(Td + T — —k)
V ；T + 2Tn
r n D Vb-Pa 2k、 /rt\=PaH--x (3--) (2)
6n另外，在成为算出对象的控制轴的第I标志为“I”、第2标志为“0”的情况下，即在第I定时与基准定时间隔了“2X控制周期T”、基准定时与第2定时间隔了“控制周期T”的情况下，数据处理部63利用以下所示的式(3)，算出检测出触发信号时的该控制轴的关节角度。式3
pA _ pnrTP(々)= Pa +-X (Td + 2T--k)
r n ^ Vb-Pa .r 2k, /0\=PaH--x (5--) ... (3)
6n另外，在成为算出对象的控制轴的第I标志和第2标志均为“I”的情况下，即在第I定时与基准定时间隔了 “2X控制周期T”、基准定时与第2定时间隔了 “2X控制周期T”的情况下，数据处理部63利用以下所示的式(4)，算出检测出触发信号时的该控制轴的关节角度。式4
1.一种机械手位置检测装置，其特征在于，具备
位置数据取得部，其取得表示实际的机械手的位置的位置数据；
位置数据输入部，其被输入从上述位置数据取得部输出的上述位置数据；和位置算出部，其通过线性插值来算出计算上的机械手的位置，该线性插值使用了在不同的定时被输入给上述位置数据输入部的第I以及第2位置数据。
2.根据权利要求I所述的机械手位置检测装置，其特征在于，
上述位置数据取得部是设置于上述机械手的编码器，
上述位置算出部接受用于检测上述机械手的位置的指令，算出上述计算上的机械手的位置，
上述第I位置数据是在上述指令之前的定时取得的数据，
上述第2位置数据是在上述指令之后的定时取得的数据。
3.根据权利要求2所述的机械手位置检测装置，其特征在于，
上述位置算出部具备指令检测部，该指令检测部能够以比取得从I个编码器输入给上述位置数据输入部的上述位置数据的规定周期T短的周期Ts，检测上述指令。
4.根据权利要求3所述的机械手位置检测装置，其特征在于，
上述位置算出部按照每个周期T/n，取得来自相互不同的编码器的位置数据，并按照每一个上述编码器输出被输入上述指令时的上述机械手的位置，所述周期T/n是将上述规定周期T以I以上的整数n进行n等分而得到的周期。
5.根据权利要求I 4中任意一项所述的机械手位置检测装置，其特征在于，
上述位置算出部对所取得的上述位置数据是否正常进行判断，
在判断为检测到上述指令时的前一上述位置数据不正常的情况下，将在该位置数据之前取得的前一位置数据作为上述第I位置数据使用。
6.根据权利要求5所述的机械手位置检测装置，其特征在于，
上述位置算出部在判断为紧接着检测到上述指令后取得的上述位置数据不正常的情况下，将紧接着该位置数据后取得的位置数据作为上述第2位置数据使用。
7.一种机械手系统，其特征在于，具备
搬运工件的机械手；
机械手控制器，其具备输出用于检测上述机械手的位置的指令的指令输出部，使上述机械手动作；
还具备权利要求I 6中任意一项所述的机械手位置检测装置。
8.根据权利要求7所述的机械手系统，其特征在于，还具备
照相机，其通过在被输入来自上述指令输出部的上述指令的定时，对预定的拍摄范围进行拍摄，来取得包含向目标位置移动过程中的上述机械手所搬运的工件的图像；
工件位置取得部，其基于上述照相机所取得的图像，取得上述工件的位置；和目标位置修正部，其基于上述工件位置取得部取得的上述工件的位置、和由上述机械手位置检测装置算出的上述计算上的机械手的位置，对上述目标位置进行修正。
本发明涉及一种检测机械手位置的机械手位置检测装置以及具备该机械手位置检测装置的机械手系统。位置算出部具备触发信号输入部，被输入触发信号；位置数据输入部，延迟通信时间地被输入从编码器输出的位置数据；数据处理部，取得被输入的位置数据，算出检测出触发信号时的机械手的位置。数据处理部使用检测触发信号前所取得的第1位置数据和其定时、以及检测到触发信号后的第2位置数据和其定时，对机械手的位置进行线性插值，算出与被输入触发信号的定时相比滞后通信时间的位置，作为检测出触发信号时的机械手的位置。
文档编号B25J9/16GKSQ
公开日日 申请日期日 优先权日日
发明者浅田笃 申请人:精工爱普生株式会社