CN105455834A - X光机运动轨迹规划方法与装置 - Google Patents
X光机运动轨迹规划方法与装置 Download PDFInfo
- Publication number
- CN105455834A CN105455834A CN201410438924.XA CN201410438924A CN105455834A CN 105455834 A CN105455834 A CN 105455834A CN 201410438924 A CN201410438924 A CN 201410438924A CN 105455834 A CN105455834 A CN 105455834A
- Authority
- CN
- China
- Prior art keywords
- ray
- receiving system
- ray generator
- ray receiving
- generator
- 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.)
- Granted
Links
Abstract
一种X光机运动轨迹规划方法与装置,所述方法包括:设定在机架摆位时控制X光机的X射线发生装置和X射线接收装置进行运动各自所要达到的目标位置;在所述X射线发生装置和X射线接收装置运动过程中,实时获取所述X射线发生装置和X射线接收装置的当前位置;若所述当前位置与目标位置不一致,则以人工势场法计算所述X射线发生装置和X射线接收装置的各运动轴速度;基于计算出的所述各运动轴速度控制所述X射线发生装置和X射线接收装置进行运动。本发明技术方案能够实现X光机在机架摆位时简单、快捷地规划出既平滑又安全,且适合多目标同时运动时的运动路径。
Description
技术领域
本发明涉及X射线摄影系统技术领域,特别涉及一种X光机运动轨迹规划方法与装置。
背景技术
目前市场上部分医用数字化X射线摄影(DR,DigitalRadiography)系统在机架摆位时采用了电动一键到位功能,在电动过程中需要解决路径规划和防碰撞问题。
现有技术中,DR系统采用的一键到位路径规划方法一般为路径插值算法,通过在当前位置和目标位置之间计算出中间位置点来避开障碍,能够确保一定的安全性,而且该算法简单易行,针对于运动较为简单的X光机有一定优势,但是运动路径被分割为多条直线,轨迹不够平滑。若是仅仅追求运动轨迹的平滑性,则又无法确保在机架摆位时X光机的相关部件运动过程中的安全性。
此外,现有技术中通常采用的静态路径规划算法,难以解决多目标同时运动时路径复杂变化的问题。
因此,现有技术无法实现X光机在机架摆位时简单、快捷地规划出既平滑又安全,且适合多目标同时运动时的运动路径。
发明内容
本发明要解决的是现有技术规划X光机在机架摆位时的运动路径不够平滑和安全,且无法解决多目标同时运动时路径复杂变化的问题。
为解决上述问题,本发明技术方案提供一种X光机运动轨迹规划方法,包括:
设定在机架摆位时控制X光机的X射线发生装置和X射线接收装置进行运动各自所要达到的目标位置;
在所述X射线发生装置和X射线接收装置运动过程中,实时获取所述X射线发生装置和X射线接收装置的当前位置;
若所述当前位置与目标位置不一致,则以人工势场法计算所述X射线发生装置和X射线接收装置的各运动轴速度;
基于计算出的所述各运动轴速度控制所述X射线发生装置和X射线接收装置进行运动。
可选的,所述以人工势场法计算所述X射线发生装置和X射线接收装置的各运动轴速度包括:
将所述X射线发生装置和X射线接收装置互为各自运动至目标位置途中的障碍物;
以所述X射线发生装置的旋转中心为球心,且能完全容纳所述X射线发生装置的球形区域作为所述X射线发生装置的碰撞区域;
以所述X射线接收装置的旋转中心为球心,且能完全容纳所述X射线接收装置的球形区域作为所述X射线接收装置的碰撞区域。
可选的,所述以人工势场法计算所述X射线发生装置和X射线接收装置的各运动轴速度还包括:
分别计算所述X射线发生装置和X射线接收装置各自运动至目标位置途中所有障碍物的排斥力;
分别计算所述X射线发生装置和X射线接收装置各自目标位置的吸引力;
分别计算所述X射线发生装置和X射线接收装置各自所对应排斥力与吸引力的合力;
根据所述合力计算所述X射线发生装置和X射线接收装置的各运动轴速度。
可选的,所述分别计算所述X射线发生装置和X射线接收装置各自运动至目标位置途中所有障碍物的排斥力包括:
若DFT小于或等于Dmax,则:
其中,DFT为所述X射线发生装置的碰撞区域或所述X射线接收装置的碰撞区域与其障碍物的碰撞区域之间的距离,和分别是DFT在x轴方向和z轴方向的分量,Dmax为障碍物开始排斥的最大距离阈值,和分别为所述X射线发生装置或所述X射线接收装置在x轴方向的排斥力和在z轴方向的排斥力,KF为比例系数。
可选的,所述分别计算所述X射线发生装置和X射线接收装置各自目标位置的吸引力包括:
若Dg大于或等于Dmin,则:
其中,分别为所述X射线发生装置或所述X射线接收装置在x轴方向目标位置的吸引力和在z轴方向目标位置的吸引力,Kg为比例系数,Dmin为当前位置与目标位置之间的距离偏差阈值,Dgoal为所述X射线发生装置或所述X射线接收装置的当前位置与相应目标位置之间的距离,Drun为吸引力最小阈值,和分别是Dgoal在x轴方向和z轴方向的分量。
可选的,所述根据所述合力计算所述X射线发生装置和X射线接收装置的各运动轴速度包括:
其中,分别为所述X射线发生装置或所述X射线接收装置在x轴和z轴方向的速度,为所述X射线发生装置或所述X射线接收装置在x轴和z轴方向的合力,Kv为力与速度的转换比例系数,分别为x轴和z轴方向的最大速度。
可选的,所述X射线发生装置包括球管和限束器,所述X射线接收装置包括内置平板探测器的胸片盒。
为解决上述问题,本发明技术方案还提供一种X光机运动轨迹规划装置,包括:
设定单元,适于设定在机架摆位时控制X光机的X射线发生装置和X射线接收装置进行运动各自所要达到的目标位置;
位置获取单元,适于在所述X射线发生装置和X射线接收装置运动过程中,实时获取所述X射线发生装置和X射线接收装置的当前位置;
计算单元,适于在所述当前位置与目标位置不一致时,以人工势场法计算所述X射线发生装置和X射线接收装置的各运动轴速度;
控制单元,适于基于计算出的所述各运动轴速度控制所述X射线发生装置和X射线接收装置进行运动。
与现有技术相比,本发明的技术方案至少具有以下优点:
在X光机的机架摆位执行一键到位时,通过人工势场法计算X光机中X射线发生装置和X射线接收装置的各运动轴速度,并以此进行实时速度的控制,从而能够在解决防碰撞问题(确保安全性)的前提下,使得一键到位的路径相比于普通的点到点路径插值算法更加平滑,且相比于静态路径规划算法,能够解决多目标同时运动时路径复杂变化的问题。
通过将X光机的机架形态转换为简单的形状模型,并按照该形状模型确定以人工势场法进行相关计算过程中X射线发生装置和X射线接收装置各自的碰撞区域,如此使X光机中X射线发生装置和X射线接收装置的旋转运动将不会影响碰撞区域的形状和位置,从而实现了X射线发生装置旋转速度和X射线接收装置旋转速度与其他各个轴速度之间的解耦,使得相关计算更为简单和快捷。
由于X光机一键到位过程中,X射线发生装置和X射线接收装置均为通过固定的导轨沿X轴或Z轴方向做直线运动,因此在应用上避开了人工势场法所存在的局部极小问题。
附图说明
图1是本发明技术方案提供的X光机运动轨迹规划方法的流程示意图;
图2是通过人工势场法进行路径规划的原理示意图;
图3是本发明实施例的X光机一键到位的流程示意图;
图4是本发明实施例的X光机的机架形态的示意图;
图5是由图4所示X光机的机架形态转换而成的形状模型的示意图;
图6是本发明实施例的计算球管和胸片盒的各运动轴速度的流程示意图;
图7是本发明实施例的X光机人工势场法路径规划的示意图。
具体实施方式
现有技术中,通常采用路径插值算法规划X光机在机架摆位时的运动路径,虽然该方法能够较为简单地解决防碰撞问题,确保X光机的相关部件在一键到位的运动过程中的安全性,但是由于运动路径被分割为多条直线,导致轨迹不够平滑,而且现有的静态路径规划算法,也难以解决多目标同时运动时路径复杂变化的问题。
为解决上述问题,本发明技术方案在X光机电动运动中引入了一种基于人工势场法的运动轨迹规划方法,该方法通过人工势场法计算X光机中相关部件运动过程中各运动轴速度,并以此进行实时速度的控制,由此能够实现在X光机的一键到位时简单、快捷地规划出既平滑又安全,且适合多目标同时运动时的运动路径。
如图1所示,本发明技术方案提供的X光机运动轨迹规划方法包括:
步骤S101,设定在机架摆位时控制X光机的X射线发生装置和X射线接收装置进行运动各自所要达到的目标位置;
步骤S102,在所述X射线发生装置和X射线接收装置运动过程中,实时获取所述X射线发生装置和X射线接收装置的当前位置;
步骤S103,若所述当前位置与目标位置不一致,则以人工势场法计算所述X射线发生装置和X射线接收装置的各运动轴速度;
步骤S104,基于计算出的所述各运动轴速度控制所述X射线发生装置和X射线接收装置进行运动。
其中,在具体实施时,步骤S103中所述以人工势场法计算所述X射线发生装置和X射线接收装置的各运动轴速度可以包括:将所述X射线发生装置和X射线接收装置互为各自运动至目标位置途中的障碍物;以所述X射线发生装置的旋转中心为球心,且能完全容纳所述X射线发生装置的球形区域作为所述X射线发生装置的碰撞区域;以所述X射线接收装置的旋转中心为球心,且能完全容纳所述X射线接收装置的球形区域作为所述X射线发生装置的碰撞区域。
为使本发明的上述目的、特征和优点能够更为明显易懂,下面结合附图对本发明的具体实施例作详细的说明。
先对通过人工势场法进行路径规划的原理进行简单介绍。
基于人工势场法的路径规划方法能够用于多个物体运动到不同目标点的场景,该方法可以很好的解决多物体之间的防碰撞问题,且应用势场法规划出来的路径一般是比较平滑并且安全的。如图2所示,它的基本思想是将物体在周围环境中的运动,设计成一种抽象的人造引力场中的运动,目标点(即物体运动所要达到的目标位置)对物体产生“引力”,障碍物对物体产生“斥力”,最后通过求“合力”来控制物体的运动。
本实施例中,以所述X射线发生装置包括球管和限束器,所述X射线接收装置包括内置平板探测器的胸片盒为例进行说明,在其他实施例中,X射线发生装置和X射线接收装置都还可以包含其他相关部件,而且X射线接收装置也并非一定是以胸片盒的形态存在。由于X光机中球管、限束器、平板探测器以及胸片盒等概念都是本领域技术人员所公知的,因此对于这些部件的构造和功能此处不作详细介绍。
需要说明的是,在实际实施时,尽管与球管相连接的限束器属于X射线发生装置的组成部分之一,但由于其是随球管一起运动的,而且应用人工势场法时需要确定碰撞区域(参见后面相关描述),X射线发生装置的碰撞区域主要是由球管的构造特点所决定的,一般与限束器的构造特点关系不大,因此,为了方便叙述,在本实施例中仅以球管作为考察对象进行说明。
X光机在一键到位过程中,需要球管和胸片盒同时运动,将人工势场法应用于X光机的悬吊架和胸片架的运动路径规划,可以兼顾多物体运动防碰撞以及轨迹平滑的需求。而X光机本身运动的特性,即X射线发生装置和X射线接收装置均是通过固定的导轨沿X轴或Z轴方向做直线运动,又弥补了人工势场法所存在的局部极小问题。
用户设置了一键到位的目标点后,X光机系统控制软件需要控制驱动器,使各运动轴运动,从而使球管和胸片盒到达指定位置,方便医师完成曝光操作。整个一键到位过程中控制的关键在于路径规划,本发明实施例中采用了人工势场法计算球管和胸片盒的各运动轴速度,实现了防碰撞和路径规划功能。
如图3所示,本发明实施例的X光机一键到位的流程如下:
首先执行步骤S201,设置球管和胸片盒一键到位的目标位置。步骤S201之后,执行步骤S202,获取球管和胸片盒的当前位置。
在步骤S202中,对于球管的当前位置以及胸片盒的当前位置都是采用实时获取、不断更新的方式,获取到球管和胸片盒各自所处的当前位置之后,将相关数据反馈至X光机系统控制软件,以便后续步骤中与设置的球管和胸片盒一键到位的目标位置进行比较。
在获取到球管和胸片盒的当前位置之后,执行步骤S203,判断当前位置是否与目标位置一致。
具体地,就球管来说,将获取到的球管的当前位置与此前所设置的球管的目标位置进行比较:若两者一致,则表明球管已经运动到了预设的目标位置,简单地说,球管已经到位了,此时对于球管的一键到位已结束;若两者不一致,则球管仍然未到位,需要控制驱动器使球管继续向着目标位置进行运动。
类似地,就胸片盒来说,需要将获取到的胸片盒的当前位置与此前所设置的胸片盒的目标位置进行比较,若两者一致,则表明胸片盒已经完成了一键到位,若两者不一致,则表明胸片盒仍然未到位,需要控制驱动器使胸片盒继续向其相应的目标位置进行运动。
本实施例中,控制驱动器使球管和胸片盒向着各自的目标位置进行运动的各运动轴速度,是通过人工势场法计算获得的。
若通过步骤S203判断出当前位置与目标位置不一致,执行步骤S204,通过人工势场法计算球管和胸片盒的各运动轴速度。
具体实施时,通过人工势场法计算球管和胸片盒的各运动轴速度首先需要确定应用人工势场法时的障碍物和碰撞区域。
本实施例中,可以将球管和胸片盒互为各自运动至目标位置途中的障碍物;以球管的旋转中心为球心,且能完全容纳球管以及限束器的球形区域作为球管的碰撞区域;以胸片盒的旋转中心为球心,且能完全容纳胸片盒的球形区域作为胸片盒的碰撞区域。
本实施例中,为了计算方便,需要将X光机的机架形态转换为简单的形状模型。
X光机的机架形态如图4所示,其中:内置平板探测器的胸片盒设置在胸片架上,胸片盒可以绕其旋转中心作旋转运动,图4中以“Tilt”标识的箭头表示胸片盒的旋转运动,其也可以沿z轴方向进行运动;球管以及与其相连的限束器设置于悬吊架下,通过悬吊架沿x轴或z轴方向的导轨的运动可以使球管和限束器在x轴以及z轴进行运动,球管还可以绕其旋转中心作旋转运动,图4中以“RHA”标识的箭头表示球管的旋转运动。
由X光机的机架形态转换而成的形状模型如图5所示,其中,胸片盒和球管各自的碰撞区域可以分别简化为半径为rFD、rTube的球形,从图5可知,rFD通常接近于胸片盒旋转中心至胸片盒其中一端的距离,rTube通常接近于球管旋转中心至球管其中一端的距离。本实施例中,将以球管旋转中心为球心,以半径为rTube构成的球形区域作为球管的碰撞区域,简称为“球管区域”,将以胸片盒旋转中心为球心,以半径为rFD构成的球形区域作为胸片盒的碰撞区域,简称为“胸片盒区域”。此外,在图5中,球管在x轴和z轴进行运动的轴速度分别以VTubeX和VTubeZ表示,胸片盒在z轴进行运动的轴速度以VFDZ表示。
将X光机的机架形态转换成如图5所示的形状模型后,这样胸片盒和球管的旋转运动将不会影响碰撞区域的形状和位置,从而实现了胸片盒旋转速度VTilt和球管旋转速度VRHA与其他各个轴速度之间的解耦。
本实施例中,对于与胸片盒的z轴速度VFDZ、球管的z轴速度VTubeZ和x轴速度VTubeX之间互不影响的胸片盒旋转速度VTilt和球管旋转速度VRHA,可以利用比例积分微分(PID,ProportionalIntegralDerivative)控制算法计算,具体公式如下:
其中,KTp、TTi、TTd、KRp、TRi、TRd为PID常数,可以通过测试获得;ΔPTt为胸片盒Tilt轴目标角度与t时刻角度的差值;ΔPRt为球管RHA轴目标角度与t时刻角度的差值,Δt为采样周期。
胸片盒的z轴速度VFDZ、球管的z轴速度VTubeZ和x轴速度VTubeX三者会影响碰撞区域的位置,而考虑到避障,轴速度又受碰撞区域的影响。
在本发明实施例中,通过人工势场法计算出球管和胸片盒的各运动轴速度,并以此实时更新速度,从而完成避障和路径规划功能。下面以球管轴速度计算为例进行分析,此时胸片盒相对于球管为障碍物,结合图6和图7,步骤S204的具体计算方法包括如下步骤:
执行步骤S301,分别计算球管和胸片盒各自运动至目标位置途中所有障碍物的排斥力。
若以球管轴速度计算为例,步骤S301具体就是计算球管运动至目标位置途中,障碍物胸片盒对其产生的排斥力,计算方法如下:
若DFT小于或等于Dmax,则按照以下公式(2)进行计算:
其中,DFT为球管区域与胸片盒区域之间的距离,如图5所示,DFT等于球管旋转中心与胸片盒旋转中心之间的距离再减去rFD和rTube,和分别是DFT在x轴方向和z轴方向的分量,Dmax为障碍物开始排斥的最大距离阈值,和分别为球管在x轴方向的排斥力和在z轴方向的排斥力,KF为比例系数。
需要说明的是,由于本实施例中应用了人工势场法,而人工势场法中的“排斥力”和“吸引力”都是一种人为抽象出来的力,本领域技术人员能够理解的是,球管在x轴方向和在z轴方向的排斥力,指的就是球管的障碍物胸片盒对球管所形成的在x轴方向和在z轴方向的排斥力。同理,球管在x轴方向目标位置的吸引力和在z轴方向目标位置的吸引力,分别指的就是球管的目标位置对其在x轴方向和在z轴方向所形成的吸引力。
在实际实施时,若判断出DFT>Dmax,则排斥力为0,排斥力计算结束,否则继续按照公式(2)进行计算排斥力根据公式(2)可以看出,DFT越小,排斥力越大,DFT接近0时,排斥力无限大,从而保证了安全性。
执行步骤S302,分别计算球管和胸片盒各自目标位置的吸引力。
若以球管轴速度的计算为例,步骤S302具体就是计算球管的目标位置对球管产生的吸引力,计算方法如下:
若Dg大于或等于Dmin,则按照以下公式(3)和(4)进行计算:
其中,分别为球管在x轴方向目标位置的吸引力和在z轴方向目标位置的吸引力,Kg为比例系数,Dmin为当前位置与目标位置之间的距离偏差阈值,Dgoal为球管的当前位置与相应目标位置之间的距离,Drun为吸引力最小阈值,和分别是Dgoal在x轴方向和z轴方向的分量。
在实际实施时,若判断出Dgoal<Dmin,则认为设置的球管的目标位置已经到达,将和置为0,吸引力计算结束,否则继续按照以下公式(3)和(4)进行计算。
需要说明的是,所述距离偏差阈值Dmin由精度要求决定,设置吸引力最小阈值Drun的作用是能够防止吸引力过小导致运动速度过慢。
执行步骤S303,分别计算球管和胸片盒各自所对应排斥力与吸引力的合力;
若以球管轴速度的计算为例,步骤S303具体就是计算球管在x轴方向和z轴方向所对应排斥力与吸引力的合力,计算方法如下:
其中,是球管在x轴方向所对应排斥力与吸引力的合力,是球管在z轴方向所对应排斥力与吸引力的合力。
执行步骤S304,根据所述合力计算球管和胸片盒的各运动轴速度。
若以球管轴速度的计算为例,步骤S304具体就是计算球管在x轴速度和在z轴速度。根据合力计算速度的公式如下:
其中,分别为球管在x轴和z轴方向的速度,Kv为力与速度的转换比例系数,分别为球管在x轴和z轴方向的最大速度。
本领域技术人员能够理解的是,胸片盒的z轴速度VFDZ计算方法同上,区别只是将球管作为障碍物。
步骤S204之后,则执行步骤S205,将计算出的球管和胸片盒的各运动轴速度发送给驱动器进行运动控制。
具体地,当球管和胸片盒在各个轴的速度计算出来后,即可将计算得到的速度值发送到各个轴的驱动器中,从而控制机架运动,实现了X光机的一键到位路径规划和避障功能。
由于控制机架运动需要根据实时计算获得的球管和胸片盒在各个轴的速度,因此步骤S205之后仍然需要跳转到步骤S202,继续获取球管和胸片盒的当前位置,循环执行相关步骤,直至步骤S203判断出当前位置与目标位置一直,则结束X光机的一键到位操作。
由于驱动器根据球管和胸片盒的轴速度控制机架运动的过程为本领域技术人员所知晓,此处不再详细描述。
基于上述X光机运动轨迹规划方法,本实施例还提供一种X光机运动轨迹规划装置,包括:设定单元,适于设定在机架摆位时控制X光机的X射线发生装置和X射线接收装置进行运动各自所要达到的目标位置;位置获取单元,适于在所述X射线发生装置和X射线接收装置运动过程中,实时获取所述X射线发生装置和X射线接收装置的当前位置;计算单元,适于在所述当前位置与目标位置不一致时,以人工势场法计算所述X射线发生装置和X射线接收装置的各运动轴速度;控制单元,适于基于计算出的所述各运动轴速度控制所述X射线发生装置和X射线接收装置进行运动。
具体实施时,所述计算单元在以人工势场法计算所述X射线发生装置和X射线接收装置的各运动轴速度时,将所述X射线发生装置和X射线接收装置互为各自运动至目标位置途中的障碍物,以所述X射线发生装置的旋转中心为球心,且能完全容纳所述X射线发生装置的球形区域作为所述X射线发生装置的碰撞区域,以所述X射线接收装置的旋转中心为球心,且能完全容纳所述X射线接收装置的球形区域作为所述X射线发生装置的碰撞区域。
本实施例中,所述X射线发生装置包括球管和限束器,所述X射线接收装置包括内置平板探测器的胸片盒。
所述X光机运动轨迹规划装置的具体实施可以参考上述X光机运动轨迹规划方法的实施,此处不再赘述。
本领域技术人员可以理解,实现上述实施例中所述X光机运动轨迹规划装置的全部或部分是可以通过程序来指令相关的硬件来完成,所述的程序可以存储于计算机可读存储介质中,所述存储介质可以是ROM、RAM、磁碟、光盘等。
虽然本发明披露如上,但本发明并非限定于此。任何本领域技术人员,在不脱离本发明的精神和范围内,均可作各种更动与修改,因此本发明的保护范围应当以权利要求所限定的范围为准。
Claims (10)
1.一种X光机运动轨迹规划方法,其特征在于,包括:
设定在机架摆位时控制X光机的X射线发生装置和X射线接收装置进行运动各自所要达到的目标位置;
在所述X射线发生装置和X射线接收装置运动过程中,实时获取所述X射线发生装置和X射线接收装置的当前位置;
若所述当前位置与目标位置不一致,则以人工势场法计算所述X射线发生装置和X射线接收装置的各运动轴速度;
基于计算出的所述各运动轴速度控制所述X射线发生装置和X射线接收装置进行运动。
2.根据权利要求1所述的X光机运动轨迹规划方法,其特征在于,所述以人工势场法计算所述X射线发生装置和X射线接收装置的各运动轴速度包括:
将所述X射线发生装置和X射线接收装置互为各自运动至目标位置途中的障碍物;
以所述X射线发生装置的旋转中心为球心,且能完全容纳所述X射线发生装置的球形区域作为所述X射线发生装置的碰撞区域;
以所述X射线接收装置的旋转中心为球心,且能完全容纳所述X射线接收装置的球形区域作为所述X射线接收装置的碰撞区域。
3.根据权利要求2所述的X光机运动轨迹规划方法,其特征在于,所述以人工势场法计算所述X射线发生装置和X射线接收装置的各运动轴速度还包括:
分别计算所述X射线发生装置和X射线接收装置各自运动至目标位置途中所有障碍物的排斥力;
分别计算所述X射线发生装置和X射线接收装置各自目标位置的吸引力;
分别计算所述X射线发生装置和X射线接收装置各自所对应排斥力与吸引力的合力;
根据所述合力计算所述X射线发生装置和X射线接收装置的各运动轴速度。
4.根据权利要求3所述的X光机运动轨迹规划方法,其特征在于,所述分别计算所述X射线发生装置和X射线接收装置各自运动至目标位置途中所有障碍物的排斥力包括:
若DFT小于或等于Dmax,则:
其中,DFT为所述X射线发生装置的碰撞区域或所述X射线接收装置的碰撞区域与其障碍物的碰撞区域之间的距离,和分别是DFT在x轴方向和z轴方向的分量,Dmax为障碍物开始排斥的最大距离阈值,和分别为所述X射线发生装置或所述X射线接收装置在x轴方向的排斥力和在z轴方向的排斥力,KF为比例系数。
5.根据权利要求3所述的X光机运动轨迹规划方法,其特征在于,所述分别计算所述X射线发生装置和X射线接收装置各自目标位置的吸引力包括:
若Dg大于或等于Dmin,则:
其中,分别为所述X射线发生装置或所述X射线接收装置在x轴方向目标位置的吸引力和在z轴方向目标位置的吸引力,Kg为比例系数,Dmin为当前位置与目标位置之间的距离偏差阈值,Dgoal为所述X射线发生装置或所述X射线接收装置的当前位置与相应目标位置之间的距离,Drun为吸引力最小阈值,和分别是Dgoal在x轴方向和z轴方向的分量。
6.根据权利要求3所述的X光机运动轨迹规划方法,其特征在于,所述根据所述合力计算所述X射线发生装置和X射线接收装置的各运动轴速度包括:
其中,分别为所述X射线发生装置或所述X射线接收装置在x轴和z轴方向的速度,为所述X射线发生装置或所述X射线接收装置在x轴和z轴方向的合力,Kv为力与速度的转换比例系数,分别为x轴和z轴方向的最大速度。
7.根据权利要求1所述的X光机运动轨迹规划方法,其特征在于,所述X射线发生装置包括球管和限束器,所述X射线接收装置包括内置平板探测器的胸片盒。
8.一种X光机运动轨迹规划装置,其特征在于,包括:
设定单元,适于设定在机架摆位时控制X光机的X射线发生装置和X射线接收装置进行运动各自所要达到的目标位置;
位置获取单元,适于在所述X射线发生装置和X射线接收装置运动过程中,实时获取所述X射线发生装置和X射线接收装置的当前位置;
计算单元,适于在所述当前位置与目标位置不一致时,以人工势场法计算所述X射线发生装置和X射线接收装置的各运动轴速度;
控制单元,适于基于计算出的所述各运动轴速度控制所述X射线发生装置和X射线接收装置进行运动。
9.根据权利要求8所述的X光机运动轨迹规划装置,其特征在于,所述计算单元在以人工势场法计算所述X射线发生装置和X射线接收装置的各运动轴速度时,将所述X射线发生装置和X射线接收装置互为各自运动至目标位置途中的障碍物,以所述X射线发生装置的旋转中心为球心,且能完全容纳所述X射线发生装置的球形区域作为所述X射线发生装置的碰撞区域,以所述X射线接收装置的旋转中心为球心,且能完全容纳所述X射线接收装置的球形区域作为所述X射线接收装置的碰撞区域。
10.根据权利要求8所述的X光机运动轨迹规划装置,其特征在于,所述X射线发生装置包括球管和限束器,所述X射线接收装置包括内置平板探测器的胸片盒。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410438924.XA CN105455834B (zh) | 2014-08-30 | 2014-08-30 | X光机运动轨迹规划方法与装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410438924.XA CN105455834B (zh) | 2014-08-30 | 2014-08-30 | X光机运动轨迹规划方法与装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN105455834A true CN105455834A (zh) | 2016-04-06 |
CN105455834B CN105455834B (zh) | 2020-08-04 |
Family
ID=55594343
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201410438924.XA Active CN105455834B (zh) | 2014-08-30 | 2014-08-30 | X光机运动轨迹规划方法与装置 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN105455834B (zh) |
Cited By (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103876759A (zh) * | 2012-12-20 | 2014-06-25 | 上海联影医疗科技有限公司 | X射线摄影系统及其控制方法 |
CN106137394A (zh) * | 2016-06-15 | 2016-11-23 | 谢东儒 | 一种获取椎弓根标准轴位图的方法 |
CN107440735A (zh) * | 2017-09-27 | 2017-12-08 | 上海联影医疗科技有限公司 | 一种ct扫描球管角度初始化的方法和系统 |
CN109621231A (zh) * | 2017-12-29 | 2019-04-16 | 上海联影医疗科技有限公司 | 多组件同步运动的轨迹优化方法、系统、装置及存储介质 |
US11253221B2 (en) * | 2017-06-01 | 2022-02-22 | Shanghai United Imaging Healthcare Co., Ltd. | Systems and methods for configuring medical device |
US11737721B2 (en) | 2016-06-14 | 2023-08-29 | Shanghai United Imaging Healthcare Co., Ltd. | Unified trajectory generation process and system |
Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5485502A (en) * | 1994-07-26 | 1996-01-16 | Lunar Corporation | Radiographic gantry with software collision avoidance |
US20050094770A1 (en) * | 2003-10-14 | 2005-05-05 | Franz Fadler | Adjustable X-ray system |
US20080162046A1 (en) * | 2006-10-24 | 2008-07-03 | General Electric Company | Method and system for tracking an arrangement of medical apparatuses |
CN101327127A (zh) * | 2007-06-21 | 2008-12-24 | 上海西门子医疗器械有限公司 | 图像重构中的投影角获取方法和装置 |
CN101766489A (zh) * | 2008-12-25 | 2010-07-07 | 株式会社东芝 | X射线诊断装置 |
CN102525530A (zh) * | 2010-10-29 | 2012-07-04 | 通用电气公司 | C形臂ct的智能自旋测试 |
CN103365299A (zh) * | 2013-08-02 | 2013-10-23 | 中国科学院自动化研究所 | 一种无人机的避障方法及其装置 |
CN103995984A (zh) * | 2014-06-09 | 2014-08-20 | 武汉科技大学 | 一种基于椭圆约束的机器人路径规划方法和装置 |
-
2014
- 2014-08-30 CN CN201410438924.XA patent/CN105455834B/zh active Active
Patent Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5485502A (en) * | 1994-07-26 | 1996-01-16 | Lunar Corporation | Radiographic gantry with software collision avoidance |
US20050094770A1 (en) * | 2003-10-14 | 2005-05-05 | Franz Fadler | Adjustable X-ray system |
US20080162046A1 (en) * | 2006-10-24 | 2008-07-03 | General Electric Company | Method and system for tracking an arrangement of medical apparatuses |
CN101327127A (zh) * | 2007-06-21 | 2008-12-24 | 上海西门子医疗器械有限公司 | 图像重构中的投影角获取方法和装置 |
CN101766489A (zh) * | 2008-12-25 | 2010-07-07 | 株式会社东芝 | X射线诊断装置 |
CN102525530A (zh) * | 2010-10-29 | 2012-07-04 | 通用电气公司 | C形臂ct的智能自旋测试 |
CN103365299A (zh) * | 2013-08-02 | 2013-10-23 | 中国科学院自动化研究所 | 一种无人机的避障方法及其装置 |
CN103995984A (zh) * | 2014-06-09 | 2014-08-20 | 武汉科技大学 | 一种基于椭圆约束的机器人路径规划方法和装置 |
Non-Patent Citations (2)
Title |
---|
张殿富等: "基于人工势场法的路径规划方法研究及期望", 《计算机工程与科学》 * |
黄炳强等: "基于人工势场法的移动机器人路径规划研究", 《计算机工程与应用》 * |
Cited By (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103876759A (zh) * | 2012-12-20 | 2014-06-25 | 上海联影医疗科技有限公司 | X射线摄影系统及其控制方法 |
US11737721B2 (en) | 2016-06-14 | 2023-08-29 | Shanghai United Imaging Healthcare Co., Ltd. | Unified trajectory generation process and system |
CN106137394A (zh) * | 2016-06-15 | 2016-11-23 | 谢东儒 | 一种获取椎弓根标准轴位图的方法 |
CN106137394B (zh) * | 2016-06-15 | 2019-09-24 | 苏州铸正机器人有限公司 | 一种获取椎弓根标准轴位图的方法 |
US11253221B2 (en) * | 2017-06-01 | 2022-02-22 | Shanghai United Imaging Healthcare Co., Ltd. | Systems and methods for configuring medical device |
CN107440735A (zh) * | 2017-09-27 | 2017-12-08 | 上海联影医疗科技有限公司 | 一种ct扫描球管角度初始化的方法和系统 |
CN109621231A (zh) * | 2017-12-29 | 2019-04-16 | 上海联影医疗科技有限公司 | 多组件同步运动的轨迹优化方法、系统、装置及存储介质 |
US11311745B2 (en) | 2017-12-29 | 2022-04-26 | Shanghai United Imaging Healthcare Co., Ltd. | System and method for synchronous motion optimization of device with moving components |
Also Published As
Publication number | Publication date |
---|---|
CN105455834B (zh) | 2020-08-04 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN105455834A (zh) | X光机运动轨迹规划方法与装置 | |
CN107490965B (zh) | 一种空间自由漂浮机械臂的多约束轨迹规划方法 | |
Zhu et al. | A convex optimization approach to smooth trajectories for motion planning with car-like robots | |
Anderson et al. | Optimal feedback guidance of a small aerial vehicle in a stochastic wind | |
CN112428278A (zh) | 机械臂的控制方法、装置及人机协同模型的训练方法 | |
CN106774301A (zh) | 一种避障跟随方法和电子设备 | |
CN103970019B (zh) | 一种基于加速度动态配置的空间机器人抖动抑制轨迹规划方法 | |
JP2011161624A (ja) | 軌道計画方法、軌道計画システム及びロボット | |
Zhong et al. | Velocity-Change-Space-based dynamic motion planning for mobile robots navigation | |
Alcalá et al. | Comparison of two non-linear model-based control strategies for autonomous vehicles | |
CN107992069A (zh) | 一种无人机路径跟踪控制的制导律设计方法 | |
Yang et al. | Smooth trajectory planning along Bezier curve for mobile robots with velocity constraints | |
Silva-Ortigoza et al. | Obstacle avoidance task for a wheeled mobile robot: A matlab-simulink-based didactic application | |
JP6664807B2 (ja) | 制御装置、制御方法、及び制御プログラム | |
CN109960145A (zh) | 移动机器人混合视觉轨迹跟踪策略 | |
Lorenzetti et al. | Reach-avoid games via mixed-integer second-order cone programming | |
JP2020093364A (ja) | 軌道生成装置 | |
Aneesh | Tracking Controller of mobile robot | |
Roozegar et al. | DP-based path planning of a spherical mobile robot in an environment with obstacles | |
CN107618032A (zh) | 用于基于第二轨迹控制机器人的机器人运动的方法和装置 | |
Jiang et al. | Obstacle avoidance and motion control of a two wheeled mobile robot using SVR technique | |
CN107466371B (zh) | 目标跟踪装置及系统、机器人 | |
Salaris et al. | The geometry of confocal curves for passing through a door | |
CN105527980A (zh) | 双目视觉系统目标跟踪控制方法 | |
Li et al. | Relative state estimation of model-unknown spinning noncooperative target using stereo EKF-SLAM |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant | ||
CP01 | Change in the name or title of a patent holder | ||
CP01 | Change in the name or title of a patent holder |
Address after: 201807 2258 Chengbei Road, Jiading District, Shanghai Patentee after: Shanghai Lianying Medical Technology Co., Ltd Address before: 201807 2258 Chengbei Road, Jiading District, Shanghai Patentee before: SHANGHAI UNITED IMAGING HEALTHCARE Co.,Ltd. |