工程车辆工作装置控制方法、装置、设备和存储介质与流程

文档序号:23728855发布日期:2021-01-26 19:01阅读:57来源:国知局
工程车辆工作装置控制方法、装置、设备和存储介质与流程

[0001]
本申请涉及工程机械技术领域,具体涉及一种工程车辆工作装置控制方法、装置、设备和存储介质。


背景技术:

[0002]
工程车辆是装备工业的重要组成部分,是土石方施工工程、路面建设与养护、流动式起重装卸作业和各种建筑工程所需的综合性机械化施工工程所必需的机械装备。
[0003]
传统工程车辆的工作装置的运动主要是通过驾驶员来进行控制的,并且目前的工程车辆基本使用液压缸驱动工作装置,这就使得只能采用在外部添加位移传感器或其他传感器的方法来对工作装置的运动状态进行测量。
[0004]
而由于工程车辆的工作环境往往十分恶劣,经常工作于高温、灰尘、泥土飞溅的环境中,这样的工作环境对外部传感器的检测精度和检测寿命都产生了极大的影响,不利于对工程车辆的工作装置进行精准控制。


技术实现要素:

[0005]
本申请提供一种工程车辆工作装置控制方法、装置、设备和存储介质,旨在解决由于工程车辆作业环境恶劣,容易对外部传感器的精度及寿命产生极大影响,不利于对工程车辆的工作装置进行精准控制的问题,实现了对工程车辆工作装置的精准测量及控制。
[0006]
第一方面,本申请提供一种工程车辆工作装置控制方法,应用于目标工作装置控制器,所述目标工作装置控制器位于工程车辆工作装置控制系统,所述方法包括:
[0007]
接收通过现场总线传输的目标工作装置的预设工作参数;
[0008]
根据所述目标工作装置的预设工作参数,控制所述目标工作装置对应的电机工作;
[0009]
接收所述电机的编码器的反馈信号;
[0010]
解析所述编码器的反馈信号,得到所述目标工作装置的实际工作参数;
[0011]
将所述目标工作装置的实际工作参数与所述目标工作装置的预设工作参数进行比较,得到比较结果;
[0012]
根据所述比较结果对所述目标工作装置的工作状态进行修正。
[0013]
在本申请一种可能的实现方式中,所述根据所述目标工作装置的预设工作参数,控制所述目标工作装置对应的电机工作,包括:
[0014]
根据所述目标工作装置的预设工作参数,换算得到所述目标工作装置对应的电机的第一工作参数;
[0015]
根据所述电机的第一工作参数控制所述电机工作。
[0016]
在本申请一种可能的实现方式中,所述解析所述编码器的反馈信号,得到所述目标工作装置的实际工作参数,包括:
[0017]
解析所述编码器的反馈信号,得到所述电机的第二工作参数;
[0018]
根据所述电机的第二工作参数,换算得到所述目标工作装置的实际工作参数。
[0019]
在本申请一种可能的实现方式中,所述目标工作装置为装载机构,所述目标工作装置对应的电机为第一电机,所述电机的编码器为第一编码器,所述解析所述编码器的反馈信号,得到所述电机的第二工作参数;根据所述电机的第二工作参数,换算得到所述目标工作装置的实际工作参数,包括:
[0020]
解析所述第一编码器的反馈信号,得到所述第一电机的第二工作参数;
[0021]
利用所述第一电机的第二工作参数与所述装载机构的减速机构参数进行换算,得到所述装载机构的实际工作参数,所述装载机构的实际工作参数包括装载机构运动方向、装载机构运动速度和装载机构当前位置。
[0022]
在本申请一种可能的实现方式中,所述目标工作装置为举升机构,所述目标工作装置对应的电机为第二电机,所述电机的编码器为第二编码器,所述解析所述编码器的反馈信号,得到所述电机的第二工作参数;根据所述电机的第二工作参数,换算得到所述目标工作装置的实际工作参数,包括:
[0023]
解析所述第二编码器的反馈信号,得到所述第二电机的第二工作参数;
[0024]
利用所述第二电机的第二工作参数与所述举升机构的减速机构参数进行换算,得到所述举升机构的实际工作参数,所述举升机构的实际工作参数包括举升机构运动方向、举升机构运动速度和举升机构当前位置。
[0025]
另一方面,本申请还提供一种工程车辆工作装置控制装置,包括:
[0026]
第一接收模块,用于接收通过现场总线传输的目标工作装置的预设工作参数;
[0027]
控制模块,用于根据所述目标工作装置的预设工作参数,控制所述目标工作装置对应的电机工作;
[0028]
第二接收模块,用于接收所述电机的编码器的反馈信号;
[0029]
解析模块,用于解析所述编码器的反馈信号,得到所述目标工作装置的实际工作参数;
[0030]
比较模块,用于将所述目标工作装置的实际工作参数与所述目标工作装置的预设工作参数进行比较,得到比较结果;
[0031]
修正模块,用于根据所述比较结果对所述目标工作装置的工作状态进行修正。
[0032]
在本申请一种可能的实现方式中,所述控制模块具体用于:
[0033]
根据所述目标工作装置的预设工作参数,得到所述目标工作装置对应的电机的第一工作参数;
[0034]
根据所述电机的第一工作参数,控制所述目标工作装置的对应电机工作。
[0035]
在本申请一种可能的实现方式中,所述解析模块具体用于:
[0036]
解析所述编码器的反馈信号,得到所述电机的第二工作参数;
[0037]
根据所述电机的第二工作参数,换算得到所述目标工作装置的实际工作参数。
[0038]
另一方面,本申请还提供一种设备,所述设备包括:
[0039]
一个或多个处理器;
[0040]
存储器;以及
[0041]
一个或多个应用程序,其中所述一个或多个应用程序被存储于所述存储器中,并配置为由所述处理器执行以实现第一方面中任一项所述的方法。
[0042]
另一方面,本申请还提供一种计算机可读存储介质,其上存储有计算机程序,所述计算机程序被处理器进行加载,以执行第一方面任一项所述的方法中的步骤。
[0043]
本申请中,采用线控控制方式,利用现场总线来传输控制数据进而对目标工作装置对应的电机的运行进行控制,并且通过目标工作装置对应的电机的编码器对目标工作装置的工作参数实时进行反馈监测,以便对目标工作装置的工作状态进行实时修正,实现了无人控制,大大提高了对于工程车辆工作装置的控制精度。
附图说明
[0044]
为了更清楚地说明本申请实施例中的技术方案,下面将对实施例描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本申请的一些实施例,对于本领域技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他的附图。
[0045]
图1是本申请实施例提供的工程车辆工作装置控制系统的一个场景示意图;
[0046]
图2是本申请实施例中提供的工程车辆工作装置控制方法的一个实施例流程示意图;
[0047]
图3是本申请实施例中步骤202的一个实施例流程示意图;
[0048]
图4是本申请实施例中步骤204的一个实施例流程示意图;
[0049]
图5是本申请实施例中步骤401和步骤402的一个实施例流程示意图;
[0050]
图6是本申请实施例中步骤401和步骤402的又一个实施例流程示意图;
[0051]
图7是本申请实施例中提供的工程车辆工作装置控制装置的一个实施例结构示意图;
[0052]
图8是本申请实施例中提供的设备的一个实施例结构示意图。
具体实施方式
[0053]
下面将结合本申请实施例中的附图,对本申请实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本申请一部分实施例,而不是全部的实施例。基于本申请中的实施例,本领域技术人员在没有作出创造性劳动前提下所获得的所有其他实施例,都属于本申请保护的范围。
[0054]
在本申请的描述中,需要理解的是,术语“中心”、“纵向”、“横向”、“长度”、“宽度”、“厚度”、“上”、“下”、“前”、“后”、“左”、“右”、“竖直”、“水平”、“顶”、“底”、“内”、“外”等指示的方位或位置关系为基于附图所示的方位或位置关系,仅是为了便于描述本申请和简化描述,而不是指示或暗示所指的装置或元件必须具有特定的方位、以特定的方位构造和操作,因此不能理解为对本申请的限制。此外,术语“第一”、“第二”仅用于描述目的,而不能理解为指示或暗示相对重要性或者隐含指明所指示的技术特征的数量。由此,限定有“第一”、“第二”的特征可以明示或者隐含地包括一个或者更多个所述特征。在本申请的描述中,“多个”的含义是两个或两个以上,除非另有明确具体的限定。
[0055]
在本申请中,“示例性”一词用来表示“用作例子、例证或说明”。本申请中被描述为“示例性”的任何实施例不一定被解释为比其它实施例更优选或更具优势。为了使本领域任何技术人员能够实现和使用本申请,给出了以下描述。在以下描述中,为了解释的目的而列
出了细节。应当明白的是,本领域普通技术人员可以认识到,在不使用这些特定细节的情况下也可以实现本申请。在其它实例中,不会对公知的结构和过程进行详细阐述,以避免不必要的细节使本申请的描述变得晦涩。因此,本申请并非旨在限于所示的实施例,而是与符合本申请所公开的原理和特征的最广范围相一致。
[0056]
下面首先对本申请实施例中涉及到的一些基本概念进行介绍:
[0057]
现场总线(field bus,fb):fb是一种工业数据总线,是自动化领域中底层数据通信网络,它主要解决工业现场的智能化仪器仪表、控制器、执行机构等现场设备间的数字通信以及这些现场控制设备和高级控制系统之间的信息传递问题,具有简单、可靠、经济实用等一系列优点。常用的现场总线类型有程序总线网络(process field bus,profibus)、以太网控制自动化技术系统(ether control automation technology,ethercat)、控制网(control net,controlnet)、串行通信rs485/rs232总线、控制器局域网络(control area network,can)总线等。
[0058]
整车控制器(vehicle control unit,vcu):vcu目前常用于新能源汽车中,作为新能源汽车的中央控制单元,是整个控制系统的核心,vcu采集电机及电池状态,采集加速踏板信号、制动踏板信号、执行器及传感器信号,根据驾驶员的意图综合分析做出相应判定后,监控下层的各部件控制器的动作,它负责汽车的正常行驶、制动能量回馈、整车发动机及动力电池的能量管理、网络管理、故障诊断及处理、车辆状态监控等,从而保证整车在较好的动力性、较高经济性及可靠性状态下正常稳定地工作。
[0059]
本申请实施例提供一种工程车辆工作装置控制方法、装置、设备和存储介质,以下分别进行详细说明。
[0060]
请参阅图1,图1为本申请实施例所提供的工程车辆工作装置控制系统的一个场景示意图,该工程车辆工作装置控制系统可以包括:远程控制器100、整车控制器200、目标工作装置控制器300、目标工作装置对应的电机400以及目标工作装置对应的电机400的编码器(motor encoder,me)500,目标工作装置控制器300中集成有工程车辆工作装置控制装置。请参考图1,远程控制器100、整车控制器200和目标工作装置控制器300之间通过现场总线进行数据传输,目标工作装置对应的电机400以及编码器500之间可以通过通信数据线进行通信连接。需要说明的是,本申请实施例的目标工作装置控制器300可以是多个,每一个目标工作装置控制器300对应于工程机械的一个工作装置,因此目标工作装置控制器300的具体数量根据实际应用场景进行选择,具体此处不做限定。
[0061]
本申请实施例中,远程控制器100可以是一个通用计算机设备或者是一个专用计算机设备。在具体实现中远程控制器100可以是台式机、便携式电脑、网络服务器、掌上电脑(personal digital assistant,pda)、移动手机、平板电脑、通信设备、嵌入式设备等,本实施例不限定远程控制器100的类型。
[0062]
本申请实施例中,整车控制器200与远程控制器100之间通过现场总线进行数据传输,操作人员通过在远程控制器100上设置目标工作装置的预设工作参数,远程控制器100接收该预设工作参数,并通过现场总线将该预设工作参数传输到整车控制器200。本实施例中的整车控制器200同样可以是一个通用计算机设备或者是一个专用计算机设备。在具体实现中整车控制器200可以是台式机、便携式电脑、网络服务器、掌上电脑、移动手机、平板电脑、通信设备、嵌入式设备等,本实施例不限定整车控制器200的类型。
[0063]
本申请实施例中,目标工作装置控制器300主要用于接收通过现场总线传输的目标工作装置的预设工作参数;根据所述目标工作装置的预设工作参数,控制所述目标工作装置对应的电机400工作;接收所述电机400的编码器500的反馈信号;解析所述编码器500的反馈信号,得到所述目标工作装置的实际工作参数;将所述目标工作装置的实际工作参数与所述目标工作装置的预设工作参数进行比较,得到比较结果;根据所述比较结果对所述目标工作装置的工作状态进行修正。
[0064]
本申请实施例中,目标工作装置控制器300可以是一个专用计算机设备,在具体实现中目标工作装置控制器300可以是嵌入式设备、专用集成设备等,本实施例不限定目标工作装置控制器300的类型。
[0065]
本申请实施例中,目标工作装置的对应电机400可以是目前常用的电机种类中的一种,例如,伺服电机、步进电机等;目标工作装置的对应电机400的编码器500可以是目前常用的编码器种类中的一种,例如,绝对值编码器、增量编码器、旋转变压器等,本实施例不限定电机400以及编码器500的类型。
[0066]
本领域技术人员可以理解,图1中示出的应用环境,仅仅是本申请方案的一种应用场景,并不构成对本申请方案应用场景的限定,其他的应用环境还可以包括比图1中所示更多的目标工作装置控制器300、电机400以及编码器500,例如图1中仅示出1个目标工作装置控制器300,可以理解的,该工程车辆工作装置控制系统还可以包括一个或多个与整车控制器200通信连接的其他目标工作装置控制器,具体此处不做限定。
[0067]
需要说明的是,图1所示的工程车辆工作装置控制系统的场景示意图仅仅是一个示例,本申请实施例描述的工程车辆工作装置控制系统以及场景是为了更加清楚的说明本申请实施例的技术方案,并不构成对于本申请实施例提供的技术方案的限定,本领域普通技术人员可知,随着工程车辆工作装置控制系统的演变和新业务场景的出现,本申请实施例提供的技术方案对于类似的技术问题,同样适用。
[0068]
首先,本申请实施例提供一种工程车辆工作装置控制方法,该工程车辆工作装置控制方法的执行主体为工程车辆工作装置控制装置,该工程车辆工作装置控制装置应用于目标工作装置控制器300,该目标工作装置控制器300位于工程车辆工作装置控制系统,该工程车辆工作装置控制方法包括:接收通过现场总线传输的目标工作装置的预设工作参数;根据所述目标工作装置的预设工作参数,控制所述目标工作装置对应的电机400工作;接收所述电机400的编码器500的反馈信号;解析所述编码器500的反馈信号,得到所述目标工作装置的实际工作参数;将所述目标工作装置的实际工作参数与所述目标工作装置的预设工作参数进行比较,得到比较结果;根据所述比较结果对所述目标工作装置的工作状态进行修正。
[0069]
如图2所示,为本申请实施例中工程车辆工作装置控制方法的一个实施例流程示意图,该工程车辆工作装置控制方法包括:
[0070]
201、接收通过现场总线传输的目标工作装置的预设工作参数。
[0071]
本实施例中,操作人员通过在远程控制器100上设置目标工作装置的预设工作参数,远程控制器100接收到该预设工作参数,并通过现场总线将该预设工作参数传输到与其通信的整车控制器200,整车控制器200接收到该预设工作参数,对其进行分析,判断该预设工作参数所对应的工作装置的类型,然后将该预设工作参数传输到相应的目标工作装置控
制器300。本申请实施例中的现场总线采用控制器局域网络(control area network,can)总线,需要说明的是,其他类型的现场总线同样适用于本申请,具体此处不做限定。
[0072]
在一个具体实施方式中,目标工作装置的预设工作参数包括目标工作装置的运动方向、运动速度、位移等,需要说明的是,接收目标工作装置的预设工作参数的方式可以是被动接收,即当整车控制器200向目标工作装置控制器300发送数据时接收,也可以是按照一定的时间间隔主动获取,比如设置每隔30分钟目标工作装置控制器300主动向整车控制器200发起访问,获取目标工作装置的预设工作参数,当预设工作参数有变化时,便重新进行获取替换当前参数,若预设工作参数没有变化,则保持当前参数不变,预设工作参数的获取方式具体此处不做限定。
[0073]
202、根据所述目标工作装置的预设工作参数,控制所述目标工作装置对应的电机工作。
[0074]
本实施例中,工程车辆的一个工作装置对应于一个工作装置控制器,一个工作装置控制器对应于一个电机,每一个电机都配备有一个对应的编码器,因此,工作装置、工作装置控制器、工作装置的对应电机以及工作装置的对应电机的编码器存在一一对应的关系。当目标工作装置控制器300接收到目标工作装置的预设工作参数后,对其进行分析,根据分析结果控制该目标工作装置对应的电机400工作,本实施例中分析结果可以是电机400的应转圈数、转速、加速度等。
[0075]
203、接收所述电机400的编码器500的反馈信号。
[0076]
由于本申请实施例中,工程机械的工作装置、工作装置控制器、工作装置的对应电机以及工作装置的对应电机的编码器存在一一对应的关系,因此,当目标工作装置对应的电机400开始工作之后,电机400的编码器500便开始实时对该电机的工作状态进行监测,并将监测到的工作状态参数反馈到目标工作装置控制器300,此处的工作状态参数可以是电机400的实际所转圈数、实际转速、实际转动加速度等。
[0077]
204、解析所述编码器500的反馈信号,得到所述目标工作装置的实际工作参数。
[0078]
本实施例中,目标工作装置控制器300接收到编码器500的反馈信号后,对该反馈信号进行解析,通过相关的运算换算,计算得到目标工作装置的实际工作参数,此处的实际工作参数,可以包括工作装置的实际运动方向、实际运动速度、实际运动加速度、实际位移等。
[0079]
205、将所述目标工作装置的实际工作参数与所述目标工作装置的预设工作参数进行比较,得到比较结果。
[0080]
本申请实施例中,目标工作装置控制器300对其所接收到的来自编码器的反馈信号所推算的实际工作参数与来自整车控制器200的预设工作参数进行比较,得到比较结果,该比较结果反映目标工作装置的实际运动与预设目标之间的差异。
[0081]
206、根据所述比较结果对所述目标工作装置的工作状态进行修正。
[0082]
本申请实施例中,目标工作装置控制器300根据步骤205得到的比较结果,判断需要对电机400的一个或一些工作参数进行调整,然后修正其当前工作参数,使得目标工作装置的运动与预设相符,完成对目标工作装置的工作状态的修正。
[0083]
本申请实施例中,用线控控制方式,利用现场总线来传输控制数据进而对目标工作装置对应的电机400的运行进行控制,并且通过电机400的编码器500对目标工作装置的
工作参数实时进行反馈监测,以便对目标工作装置的工作状态进行实时修正,实现了无人控制,大大提高了对于工程车辆工作装置的控制精度。
[0084]
如图3所示,在本申请一些实施例中,所述步骤202中所述根据所述目标工作装置的预设工作参数,控制所述目标工作装置对应的电机400工作,可以进一步包括:
[0085]
301、根据所述目标工作装置的预设工作参数,得到所述目标工作装置对应的电机400的第一工作参数。
[0086]
在一个具体实施方式中,目标工作装置对应的电机400的轴承上套接有主动减速齿轮,目标工作装置连接有与该主动减速齿轮适配的从动减速齿轮,当电机400转动时,套接在其轴承上的主动减速齿轮会随轴承一起转动,该主动减速齿轮便会带动从动减速齿轮转动,进而带动目标工作装置运动,因此,目标工作装置的预设工作参数,例如预设运动方向、预设运动速度、预设运动位移等,需要经过与主动减速齿轮及从动减速齿轮的参数换算后,才能得到电机400的第一工作参数,比如转动方向、转动圈数、转动速度等。
[0087]
302、根据所述电机400的第一工作参数,控制所述电机400工作。
[0088]
本实施例中,目标工作装置控制器300根据步骤301中得到的第一工作参数向电机400发送控制指令,通过该控制指令控制电机400工作。
[0089]
如图4所示,在本申请一些实施例中,所述步骤204中所述解析所述编码器500的反馈信号,得到所述目标工作装置的实际工作参数,可以进一步包括:
[0090]
401、解析所述编码器500的反馈信号,得到所述电机400的第二工作参数。
[0091]
在一个具体实施方式中,编码器500的反馈信号能够反映该电机的第二工作参数,该第二工作参数即为电机的实际工作参数,例如实际所转圈数、实际旋转方向、实际转速等。
[0092]
402、根据所述电机400的第二工作参数,换算得到所述目标工作装置的实际工作参数。
[0093]
与步骤301中情况相同,本实施例的电机400的轴承上套接有主动减速齿轮,目标工作装置连接有与该主动减速齿轮适配的从动减速齿轮,当电机400转动时,套接在其轴承上的主动减速齿轮会随轴承一起转动,该主动减速齿轮便会带动从动减速齿轮转动,进而带动目标工作装置运动,因此,电机400的第二工作参数,例如实际转动方向、实际转动速度、实际转动圈数等,需要经过与主动减速齿轮及从动减速齿轮的参数换算后,才能得到目标工作装置的实际工作参数,比如实际运动方向、实际运动速度、实际运动加速度等。
[0094]
如图5所示,在本申请一些实施例中,所述目标工作装置为装载机构,所述目标工作装置对应的电机400为第一电机,所述电机400的编码器500为第一编码器,所述解析所述编码器500的反馈信号,得到所述电机400的第二工作参数;根据所述电机400的第二工作参数,得到所述目标工作装置的实际工作参数,进一步可以包括:
[0095]
501、解析所述第一编码器的反馈信号,得到所述第一电机的第二工作参数。
[0096]
在一个具体实施方式中,工程车辆的装载机构可以是料斗,一般情况下工程机械的料斗配备有一个或两个翻转电机,即第一电机,假设第一编码器的反馈信号为:第一编码器输出a相、b相和z相三个脉冲信号,a相脉冲信号与b相脉冲信号的相位相差90
°
,z相脉冲信号为单圈脉冲输出。通过在一定时间t内捕获a相脉冲信号与b相脉冲信号的值,得到第一电机的实际转速;在一定时间t内比较a相脉冲信号与b相脉冲信号的相位,得到第一电机的
实际旋转方向;在一定时间t内累积z相脉冲信号,得到第一电机实际所转圈数。
[0097]
502、利用所述第一电机的第二工作参数与所述装载机构的减速机构参数进行换算,得到所述装载机构的实际工作参数,所述装载机构的实际工作参数包括装载机构运动方向、装载机构运动速度和装载机构当前位置。
[0098]
本申请实施例中,装载机构的减速机构包括有装载减速齿轮,第一电机的第二工作参数与装载减速齿轮参数进行换算,得到装载机构的实际运动参数。假设料斗垂直位移为s1,第一减速比为η1,第一主动减速齿轮:第一从动减速齿轮=1:η1,料斗速度为v1,料斗加速度为a1,第一电机的实际转速为n1,第一电机实际所转圈数为z1,每0.5s更新料斗加速度a1,则:
[0099]
v1=n1/η1;
[0100]
a1=|v
11-v
12
|/0.5s1;
[0101]
其中,v
11
与v
12
分别为0.5s前和0.5s后的料斗速度;
[0102]
根据第一电机的转子当前位置,可以计算得到装载机构当前位置,根据第一编码器从零位到当前位置所发出的脉冲数来计算,例如,第一电机转动一圈所发出的脉冲数为100,而其从零位转到当前位置所发出的脉冲数为40,则第一电机的转子当前位置为0.4z2,则装载机构当前位置为0.4z2。
[0103]
由上述公式得到料斗的实际工作参数,例如料斗运动方向为上翻或下翻、料斗运动速度v1、料斗运动加速度a1以及料斗当前位置,即得到装载机构的实际运动参数,如装载机构运动方向、装载机构运动速度和装载机构当前位置。
[0104]
如图6所示,在本申请一些实施例中,所述目标工作装置为举升机构,所述目标工作装置对应的电机400为第二电机,所述电机400的编码器500为第二编码器,所述解析所述编码器500的反馈信号,得到所述电机400的第二工作参数;根据所述电机400的第二工作参数,换算得到所述目标工作装置的实际工作参数,进一步可以包括:
[0105]
601、解析所述第二编码器的反馈信号,得到所述第二电机的第二工作参数。
[0106]
在一个具体实施方式中,工程机械的举升机构可以是工作臂,一般情况下工程机械的工作臂配备有一个或两个举升电机,即第二电机,假设第二编码器的反馈信号为:第二编码器输出a相、b相和z相三个脉冲信号,a相脉冲信号与b相脉冲信号的相位相差90
°
,z相脉冲信号为单圈脉冲输出。通过在一定时间t内捕获a相脉冲信号与b相脉冲信号的值,得到第二电机的实际转速;在一定时间t内比较a相脉冲信号与b相脉冲信号的相位,得到第二电机的实际旋转方向;在一定时间t内累积z相脉冲信号,得到第二电机实际所转圈数。
[0107]
602、利用所述第二电机的第二工作参数与所述举升机构的减速机构参数进行换算,得到所述举升机构的实际运动参数,所述举升机构的实际运动参数包括举升机构运动方向、举升机构运动速度和举升机构当前位置。
[0108]
同样的,本申请实施例中,举升机构的减速机构包括有举升减速齿轮,第二电机的第二工作参数与举升减速齿轮参数进行换算,得到举升机构的实际运动参数。假设工作臂垂直位移为s2,第二减速比为η2,第二主动减速齿轮:第二从动减速齿轮=1:η2,工作臂速度为v2,工作臂加速度为a2,第二电机的实际转速为n2,第二电机实际所转圈数为z2,每0.5s更新车轮加速度a2,则:
[0109]
v2=n2/η2;
[0110]
a2=|v
21-v
22
|/0.5s2;
[0111]
其中,v
21
与v
22
分别为0.5s前和0.5s后的工作臂速度;
[0112]
根据第二电机的转子当前位置,可以计算得到举升机构当前位置,根据第二编码器从零位到当前位置所发出的脉冲数来计算,例如,第二电机转动一圈所发出的脉冲数为100,而其从零位转到当前位置所发出的脉冲数为30,则第二电机的转子当前位置为0.3z3,则举升机构当前位置为0.3z3。
[0113]
由上述公式得到工作臂的实际工作参数,例如工作臂运动方向为上升或下降、工作臂运动速度v2、工作臂运动加速度a2以及工作臂当前位置,即得到举升机构的实际运动参数,如举升机构运动方向、举升机构运动速度和举升机构当前位置。
[0114]
为了更好实施本申请实施例中的工程车辆工作装置控制方法,在工程车辆工作装置控制方法基础之上,本申请实施例中还提供一种工程车辆工作装置控制装置,所述工程车辆工作装置控制装置应用于目标工作装置控制器300,所述目标工作装置控制器300位于工程车辆工作装置控制系统,如图7所示,所述工程车辆工作装置控制装置700包括:
[0115]
第一接收模块701,用于接收通过现场总线传输的目标工作装置的预设工作参数;
[0116]
控制模块702,用于根据所述目标工作装置的预设工作参数,控制所述目标工作装置对应的电机400工作;
[0117]
第二接收模块703,用于接收所述电机400的编码器500的反馈信号;
[0118]
解析模块704,用于解析所述编码器500的反馈信号,得到所述目标工作装置的实际工作参数;
[0119]
比较模块705,用于将所述目标工作装置的实际工作参数与所述目标工作装置的预设工作参数进行比较,得到比较结果;
[0120]
修正模块706,用于根据所述比较结果对所述目标工作装置的工作状态进行修正。
[0121]
本申请实施例中,控制模块702采用线控控制方式,利用现场总线来传输控制数据进而对目标工作装置的对应电机400的运行进行控制,并且第二接收模块703实时接收目标工作装置的对应电机400的编码器500的反馈信号,解析模块704对反馈信号实时进行解析,对目标工作装置的运动参数进行监测,以便对目标工作装置的运动姿态进行实时修正,实现了无人控制,大大提高了对于工程机械工作装置的控制精度.
[0122]
在本申请一些实施例中,所述控制模块702具体用于:
[0123]
根据所述目标工作装置的预设工作参数,得到所述目标工作装置对应的电机400的第一工作参数;
[0124]
根据所述电机400的第一工作参数,控制所述目标工作装置的对应电机400工作。
[0125]
在本申请一些实施例中,所述解析模块具体用于:
[0126]
解析所述编码器500的反馈信号,得到所述电机400的第二工作参数;
[0127]
根据所述电机400的第二工作参数,换算得到所述目标工作装置的实际工作参数。
[0128]
本申请实施例还提供一种设备,其集成了本申请实施例所提供的任一种工程车辆工作装置控制装置,所述设备包括:
[0129]
一个或多个处理器;
[0130]
存储器;以及
[0131]
一个或多个应用程序,其中所述一个或多个应用程序被存储于所述存储器中,并
配置为由所述处理器执行上述工程车辆工作装置控制方法实施例中任一实施例中所述的工程车辆工作装置控制方法中的步骤。
[0132]
本申请实施例还提供一种设备,其集成了本申请实施例所提供的任一种工程车辆工作装置控制装置。如图8所示,其示出了本申请实施例所涉及的设备的结构示意图,具体来讲:
[0133]
该设备可以包括一个或者一个以上处理核心的处理器801、一个或一个以上计算机可读存储介质的存储器802、电源803和输入单元804等部件。本领域技术人员可以理解,图8中示出的设备结构并不构成对设备的限定,可以包括比图示更多或更少的部件,或者组合某些部件,或者不同的部件布置。其中:
[0134]
处理器801是该设备的控制中心,利用各种接口和线路连接整个设备的各个部分,通过运行或执行存储在存储器802内的软件程序和/或模块,以及调用存储在存储器802内的数据,执行设备的各种功能和处理数据,从而对设备进行整体监控。可选的,处理器801可包括一个或多个处理核心;处理器801可以是中央处理单元(central processing unit,cpu),还可以是其他通用处理器、数字信号处理器(digital signal processor,dsp)、专用集成电路(application specific integrated circuit,asic)、现成可编程门阵列(field-programmable gate array,fpga)或者其他可编程逻辑器件、分立门或者晶体管逻辑器件、分立硬件组件等。通用处理器可以是微处理器或者该处理器也可以是任何常规的处理器等,优选的,处理器801可集成应用处理器和调制解调处理器,其中,应用处理器主要处理操作系统、用户界面和应用程序等,调制解调处理器主要处理无线通信。可以理解的是,上述调制解调处理器也可以不集成到处理器801中。
[0135]
存储器802可用于存储软件程序以及模块,处理器801通过运行存储在存储器802的软件程序以及模块,从而执行各种功能应用以及数据处理。存储器802可主要包括存储程序区和存储数据区,其中,存储程序区可存储操作系统、至少一个功能所需的应用程序(比如声音播放功能、图像播放功能等)等;存储数据区可存储根据服务器的使用所创建的数据等。此外,存储器802可以包括高速随机存取存储器,还可以包括非易失性存储器,例如至少一个磁盘存储器件、闪存器件、或其他易失性固态存储器件。相应地,存储器802还可以包括存储器控制器,以提供处理器801对存储器802的访问。
[0136]
设备还包括给各个部件供电的电源803,优选的,电源803可以通过电源管理系统与处理器801逻辑相连,从而通过电源管理系统实现管理充电、放电、以及功耗管理等功能。电源803还可以包括一个或一个以上的直流或交流电源、再充电系统、电源故障检测电路、电源转换器或者逆变器、电源状态指示器等任意组件。
[0137]
该设备还可包括输入单元804,该输入单元804可用于接收输入的数字或字符信息,以及产生与用户设置以及功能控制有关的键盘、鼠标、操作杆、光学或者轨迹球信号输入。
[0138]
尽管未示出,服务器还可以包括显示单元等,在此不再赘述。具体在本实施例中,设备中的处理器801会按照如下的指令,将一个或一个以上的应用程序的进程对应的可执行文件加载到存储器802中,并由处理器801来运行存储在存储器802中的应用程序,从而实现各种功能,如下:
[0139]
接收通过现场总线传输的目标工作装置的预设工作参数;
[0140]
根据所述目标工作装置的预设工作参数,控制所述目标工作装置对应的电机400工作;
[0141]
接收所述电机400的编码器500的反馈信号;
[0142]
解析所述编码器500的反馈信号,得到所述目标工作装置的实际工作参数;
[0143]
将所述目标工作装置的实际工作参数与所述目标工作装置的预设工作参数进行比较,得到比较结果;
[0144]
根据所述比较结果对所述目标工作装置的工作状态进行修正。
[0145]
本领域普通技术人员可以理解,上述实施例的各种方法中的全部或部分步骤可以通过指令来完成,或通过指令控制相关的硬件来完成,该指令可以存储于一计算机可读存储介质中,并由处理器进行加载和执行。
[0146]
为此,本申请实施例提供一种计算机可读存储介质,该存储介质可以包括:只读存储器(read only memory,rom)、随机存取记忆体(random access memory,ram)、磁盘或光盘等。其上存储有计算机程序,所述计算机程序被处理器进行加载,以执行本申请实施例所提供的任一种工程车辆工作装置控制方法中的步骤。例如,所述计算机程序被处理器进行加载可以执行如下步骤:
[0147]
接收通过现场总线传输的目标工作装置的预设工作参数;
[0148]
根据所述目标工作装置的预设工作参数,控制所述目标工作装置对应的电机400工作;
[0149]
接收所述电机400的编码器500的反馈信号;
[0150]
解析所述编码器500的反馈信号,得到所述目标工作装置的实际工作参数;
[0151]
将所述目标工作装置的实际工作参数与所述目标工作装置的预设工作参数进行比较,得到比较结果;
[0152]
根据所述比较结果对所述目标工作装置的工作状态进行修正。
[0153]
在上述实施例中,对各个实施例的描述都各有侧重,某个实施例中没有详述的部分,可以参见上文针对其他实施例的详细描述,此处不再赘述。
[0154]
具体实施时,以上各个单元或结构可以作为独立的实体来实现,也可以进行任意组合,作为同一或若干个实体来实现,以上各个单元或结构的具体实施可参见前面的实施例,在此不再赘述。
[0155]
以上对本申请实施例所提供的一种工程车辆工作装置控制方法、装置、设备和存储介质进行了详细介绍,本文中应用了具体个例对本申请的原理及实施方式进行了阐述,以上实施例的说明只是用于帮助理解本申请的方法及其核心思想;同时,对于本领域的技术人员,依据本申请的思想,在具体实施方式及应用范围上均会有改变之处,综上所述,本说明书内容不应理解为对本申请的限制。
当前第1页1 2 3 
网友询问留言 已有0条留言
  • 还没有人留言评论。精彩留言会获得点赞!
1