CN107063233B - 基于惯性传感器的产线管控装置 - Google Patents
基于惯性传感器的产线管控装置 Download PDFInfo
- Publication number
- CN107063233B CN107063233B CN201710235275.7A CN201710235275A CN107063233B CN 107063233 B CN107063233 B CN 107063233B CN 201710235275 A CN201710235275 A CN 201710235275A CN 107063233 B CN107063233 B CN 107063233B
- Authority
- CN
- China
- Prior art keywords
- workpiece
- motion
- time
- data
- worker
- 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.)
- Active
Links
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/005—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 with correlation of navigation data from several sources, e.g. map or contour matching
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/10—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
- G01C21/12—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
- G01C21/16—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
- G01C21/165—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation combined with non-inertial navigation instruments
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- User Interface Of Digital Computer (AREA)
- General Factory Administration (AREA)
Abstract
本发明涉及一种基于惯性传感器的产线管控装置,其包括生产流水线以及手环,手环包括手环体以及位于手环体内的数据采集单元、数据处理单元以及数据传输单元;通过数据采集单元能实时采集工人工作时佩戴手环的加速度、角速度以及地磁场数据,数据处理单元能根据数据采集单元采集并传输的加速度、角速度以及地磁场数据实现对工人工作时的姿态解算、运动轨迹跟踪以及动作检测,然后根据动作检测的结果计算出工人已完成的工件数量和完成每一件工件的操作时间,最后将计算出已经完成的工件数量和完成每一件工件的操作时间通过蓝牙发送到现场信息监控***中。本发明能有效准确地检测出佩戴手环的工人在单位时间内加工完成的工件数量,从而能有效评价工人的工作效率。
Description
技术领域
本发明涉及一种监控装置,尤其是一种基于惯性传感器的产线管控装置,属于生产流水线监控的技术领域。
背景技术
随着我国制造产业的高速发展,越来越多的工厂采用流水化作业。流水化的作业方式在装配企业中可以不仅可以提高工厂的装配效率、加快生产进度,而且可以统计每个工人的生产信息状况以供管理人员调查。但是,在一条流水线生产***中,某一个工人的装配速度都有可能影响整条流水线的效率。因此,需要一套流水线监控***来监控每个工人的工作效率。
目前的流水线监控***主要是工人使用采集器扫描工件上的条形码,通过采集器里工人的工号和扫描条形码的时间来判定一个工人的操作时间和操作的工件数量。这种方式虽然可以准确的检测工人的操作时间,但是这种方式需要在生产线上额外加上条形码***和采集器,增加了工人的工作量,降低了流水线的工作效率。此外,还有文献提出了基于计算机视觉的监控工人装配动作的方法,这种监控方式只适合于流水线中的传送带上无遮挡物的情况下并且基于图像的检测方法存在一定的检测误差,容易被遮挡,并不适用于大部分的流水线装配***。
发明内容
本发明的目的是克服现有技术中存在的不足,提供一种基于惯性传感器的产线管控装置,其能有效准确地检测工人的取件和放回工件动作,从而能有效评价工人的工作效率。
按照本发明提供的技术方案,所述基于惯性传感器的产线管控装置,包括用于传送工件的生产流水线;还包括用于佩戴在操作工人手腕部的手环,所述手环包括用于佩戴手腕部的手环体以及位于所述手环体内的数据采集单元、数据处理单元以及数据传输单元;
通过数据采集单元能实时采集工人工作时佩戴手环的加速度、角速度以及地磁场数据,数据处理单元能根据数据采集单元采集并传输的加速度、角速度以及地磁场数据实现对工人工作时的姿态解算、运动轨迹跟踪以及动作检测,并根据检测的动作计算出工人已完成的工件数量和完成每一件工件的操作时间,且将计算出已经完成的工件数量和完成每一件工件的操作时间通过数据传输单元发送到现场信息监控***中。
数据处理单元对数据采集单元传输的加速度、角速度以及地磁场数据先进行零漂补偿、平滑滤波以及互补滤波后,再进行姿态解算、运动轨迹跟踪以及动作检测。
所述数据采集单元通过SPI总线与数据处理单元连接,数据采集单元包括加速度计、陀螺仪以及电子罗盘。
本发明的优点:利用手环内的数据采集单元能实时采集工人工作时佩戴手环的加速度、角速度以及地磁场数据,数据处理单元能根据数据采集单元采集并传输的加速度、角速度以及地磁场数据实现对工人工作时的姿态解算、运动轨迹跟踪以及动作检测,数据处理单元将解算的姿态、跟踪的运动轨迹以及检测的动作通过数据传输单元传输至生产流水线上的上位机内,以通过上位机统计确定工人的操作工件数以及相应的操作时间,从而能有效准确地检测工人的取件和放回工件动作,从而能有效评价工人的工作效率。
附图说明
图1本发明的结构示意图。
图2为本发明手环的结构框图。
图3为本发明的运动轨迹的示意图。
附图标记说明:1-生产流水线、2-工件、3-工作台、4-数据采集单元、5-数据处理单元、6-数据传输单元、7-电源、8-加速度计、8-陀螺仪以及9-电子罗盘。
具体实施方式
下面结合具体附图和实施例对本发明作进一步说明。
如图1所示:为了能有效准确地检测工人的取件和放回工件动作,进而能有效评价工人的工作效率,本发明包括用于传送工件2的生产流水线1;还包括用于佩戴在操作工人手腕部的手环,所述手环包括用于佩戴手腕部的手环体以及位于所述手环体内的数据采集单元4、数据处理单元5以及数据传输单元6;
通过数据采集单元4能实时采集工人工作时佩戴手环的加速度、角速度以及地磁场数据,数据处理单元5能根据数据采集单元4采集并传输的加速度、角速度以及地磁场数据实现对工人工作时的姿态解算、运动轨迹跟踪以及动作检测,并根据检测的动作计算出工人已完成的工件数量和完成每一件工件的操作时间,且将计算出已经完成的工件数量和完成每一件工件的操作时间通过数据传输单元6发送到现场信息监控***中。
具体地,将手环佩戴于操作工人的手腕部,手环具体可以采用本技术领域常用的结构形式,在操作工人从生产流水线1上取工件2、加工工件2以及往生产流水线1上放回工件2的过程中,通过手环的数据采集单元4能采集运动中手环的加速度、角速度以及地磁场数据,从而数据处理采集单元5根据数据采集单元4传输的加速度、角速度以及地磁场数据实现对工人工作时的姿态解算、运动轨迹跟踪以及动作检测,并根据检测的动作计算出工人已完成的工件数量和完成每一件工件的操作时间,且将计算出已经完成的工件数量和完成每一件工件的操作时间通过数据传输单元6发送到现场信息监控***中。
如图2所示,所述数据采集单元4通过SPI总线与数据处理单元5连接,数据采集单元4包括加速度计8、陀螺仪9以及电子罗盘10。
本发明实施例中,手环内还设有电源7,通过电源7提供加速度计、陀螺仪9、电子罗盘10、数据处理单元5以及数据传输单元6的工作电源,数据处理单元5包括微处理器,数据传输单元6包括蓝牙模块。
具体实施时,数据采集单元4采用由InvenSense公司生产的九轴惯性传感器MPU9250,九轴惯性传感器MPU9250是全球首例整合九轴运动姿态检测的数字传感器,其内部集成了三轴加速度计、三轴陀螺仪和三轴电子罗盘。加速度计8的测量范围可以达到±16g,陀螺仪9的角速度测量范围2000o/s。MPU9250传感器数据采用串行外设接口SPI(Serial Peripheral Interface)或者I2C(Inter-Integrated Circuit)总线方式与单片机进行高速通讯;本发明实施例中,采用SPI方式与微处理器进行数据交互,传输速度可以达到1MHz。数据处理单元5包括采用STM32单片机的微处理器,型号为STM32F302K8,所述微处理器体积小、功耗低,同时其内部带有DSP(Digital Signal Processor)和FPU(FloatPoint Unit),可以快速的进行数据解算和动作检测。数据传输单元6采用的蓝牙串口透传模块HC-05,该模块体积小、功耗低,最大发射功率为8db,最大传输距离80m,可以比较方便的和上位机监控***进行无线通讯。
进一步地,数据处理单元5对数据采集单元4传输的加速度、角速度以及地磁场数据先进行零漂补偿、平滑滤波以及互补滤波后,再进行姿态解算、运动轨迹跟踪以及动作检测。
本发明实施例中,数据处理单元5可采用本技术领域常用的技术手段实现零漂补偿、平滑滤波以及互补滤波,以得到准确的加速度、角速度以及地磁场数据,具体实现零漂补偿、平滑滤波以及互补滤波的过程为本技术领域人员所熟知,此处不再赘述。在进行姿态解算时,可以采用基于四元数的捷联式惯性导航方法解算出运动载体的欧拉角,即偏航角、翻滚角和俯仰角,这三者可以描绘出运动载体在空间中的实时姿态,具体进行姿态解算的过程为本技术领域人员所熟知,此处不再赘述。
为了检测工人的操作动作,首先需要确定出工人在工作时手环的实时位置信息,进而绘制出完整的运动轨迹。因此,在检测动作之前需要对工人的工作轨迹进行实时追踪。
手环的运动轨迹是根据数据采集单元4采集到的运动数据经过一系列的处理得到的位置信息绘制出,
加速度、角速度和地磁场数据经过滤波、姿态解算和卡尔曼滤波可以解算出表示载体空间状态信息的四元数。四元数是一个超复数,表达式为:
Q(q0,q1,q2,q3)=q0+q1i+q2j+q3k (1)
由公式(2)可以求得载体在空间位置相对于地面的加速度
根据公式(4),对运动速度再次进行积分可以得到载体运动的位移
本发明实施例中,主要检测的动作是以下四个动作:空手取件、带件返回、放回工件和缩手。通过惯性传感器采集一次操作工人在完整的装配工件过程中的所有动作经过轨迹追踪之后可以得到如图3所示的运动轨迹图(XY平面)。从图3中可以明显的看出:空手取件和带件返回的轨迹基本重合,可以归结为取件过程;在工作过程中会长时间停留在工作台上;放回工件动作和缩手的动作基本重合,可以归结为放件过程。
根据图3所示的运动轨迹图可以比较准确的判断出工人在操作时的所处的位置区域。在使用轨迹进行动作判断之前,为了消除人在运动时的抖动,需要对位置坐标进行平滑滤波处理,由于是在微处理中进行,本***采用多次数据取平均值的方式进行平滑滤波。平滑滤波公式为:
tn代表第n个采样点时刻,ti代表第i个采样点的时刻,N代表要进行平滑滤波的采样点个数。
得到实时的位置坐标后,可以根据坐标中x和y的大小判断出工人操作时的是处在工作过程、取件还是放回工件过程。一般地,等坐标x与坐标y的绝对值均小于0.4时,则判定为工作过程;当x<-0.4而y>0.4时,则判定为取件过程;当x>0.4且y>0.4时,则判定为放件过程。
判断出工人的是处在取件过程还是放回工件过程后还要对工人是否完成了一次完整的工件操作进行判断。在取件和放回工件过程中,工人的运动轨迹存在着重合,这就需要对运动方向进行判断。这两个过程存在一定的相似性,接下来将以放回工件的过程为例进行介绍如何进行运动方向判断。
在运动方向判定上,采用的载体运动的坐标一阶微分计算。即
Δx(ti)=x(ti)-x(ti-1) (7)
Δy(ti)=y(ti)-y(ti-1) (8)
式中,x(ti)、y(ti)为ti时刻载***置的坐标。Δx(ti)代表ti时刻的坐标中x变量的一阶微分Δy(ti)代表ti时刻的坐标中y变量的一阶微分。
载体运动中的方向向量
由公式(9)得到方向向量后,就可以判断出在取件过程中是空手取件还是带件返回动作,在放件过程中是放回工件还是缩手动作。
当连续检测到完整的取件过程、工作过程和放件过程,则可以判定为工人完成了一次工件的操作,此时应当将工人完成的工件数量增加一个,同时记录下完成这个过程所需要的时间,最后将数据以蓝牙方式发送到上位机信息监控***中。至此,就完成了一次动作检测过程。
Claims (2)
1.一种基于惯性传感器的产线管控装置,包括用于传送工件(2)的生产流水线(1);其特征是:还包括用于佩戴在操作工人手腕部的手环,所述手环包括用于佩戴手腕部的手环体以及位于所述手环体内的数据采集单元(4)、数据处理单元(5)以及数据传输单元(6);
通过数据采集单元(4)能实时采集工人工作时佩戴手环的加速度、角速度以及地磁场数据,数据处理单元(5)能根据数据采集单元(4)采集并传输的加速度、角速度以及地磁场数据实现对工人工作时的姿态解算、运动轨迹跟踪以及动作检测,并根据检测的动作计算出工人已完成的工件数量和完成每一件工件的操作时间,且将计算出已经完成的工件数量和完成每一件工件的操作时间通过数据传输单元(6)发送到现场信息监控***中;
数据处理单元(5)对数据采集单元(4)传输的加速度、角速度以及地磁场数据先进行零漂补偿、平滑滤波以及互补滤波后,再进行姿态解算、运动轨迹跟踪以及动作检测;
数据处理单元(5)根据加速度、角速度和地磁场数据经过滤波、姿态解算和卡尔曼滤波可以解算出表示载体空间状态信息的四元数;四元数是一个超复数,表达式为:
Q(q0,q1,q2,q3)=q0+q1i+q2j+q3k (1)
由公式(2)可以求得载体在空间位置相对于地面的加速度
根据公式(4),对运动速度再次进行积分可以得到载体运动的位移
对手环主要检测的动作是以下四个动作:空手取件、带件返回、放回工件和缩手;通过惯性传感器采集一次操作工人在完整的装配工件过程中的所有动作经过轨迹追踪之后可以得到运动轨迹图XY平面;在运动轨迹图中:空手取件和带件返回的轨迹基本重合,可以归结为取件过程;在工作过程中会长时间停留在工作台上;放回工件动作和缩手的动作基本重合,可以归结为放件过程;
根据运动轨迹图能比较准确的判断出工人在操作时的所处的位置区域;在使用轨迹进行动作判断之前,为了消除人在运动时的抖动,需要对位置坐标进行平滑滤波处理,由于是在微处理中进行,本***采用多次数据取平均值的方式进行平滑滤波;平滑滤波公式为:
tn代表第n个采样点时刻,ti代表第i个采样点的时刻,N代表要进行平滑滤波的采样点个数;
得到实时的位置坐标后,根据坐标中x和y的大小判断出工人操作时的是处在工作过程、取件还是放回工件过程;当坐标x与坐标y的绝对值均小于0.4时,则判定为工作过程;当x<-0.4而y>0.4时,则判定为取件过程;当x>0.4且y>0.4时,则判定为放件过程;
判断出工人的是处在取件过程还是放回工件过程后还要对工人是否完成了一次完整的工件操作进行判断;在取件和放回工件过程中,工人的运动轨迹存在着重合,这就需要对运动方向进行判断;这两个过程存在一定的相似性,接下来将以放回工件的过程为例进行介绍如何进行运动方向判断;
在运动方向判定上,采用的载体运动的坐标一阶微分计算;即
Δx(ti)=x(ti)-x(ti-1) (7)
Δy(ti)=y(ti)-y(ti-1) (8)
式中,x(ti)、y(ti)为ti时刻载***置的坐标;Δx(ti)代表ti时刻的坐标中x变量的一阶微分Δy(ti)代表ti时刻的坐标中y变量的一阶微分;
载体运动中的方向向量
由公式(9)得到方向向量后,就可以判断出在取件过程中是空手取件还是带件返回动作,在放件过程中是放回工件还是缩手动作;
当连续检测到完整的取件过程、工作过程和放件过程,则判定为工人完成了一次工件的操作,此时应当将工人完成的工件数量增加一个,同时记录下完成这个过程所需要的时间,最后将数据以蓝牙方式发送到上位机信息监控***中;至此,就完成了一次动作检测过程。
2.根据权利要求1所述的基于惯性传感器的产线管控装置,其特征是:所述数据采集单元(4)通过SPI总线与数据处理单元(5)连接,数据采集单元(4)包括加速度计(8)、陀螺仪(9)以及电子罗盘(10)。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710235275.7A CN107063233B (zh) | 2017-04-12 | 2017-04-12 | 基于惯性传感器的产线管控装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710235275.7A CN107063233B (zh) | 2017-04-12 | 2017-04-12 | 基于惯性传感器的产线管控装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN107063233A CN107063233A (zh) | 2017-08-18 |
CN107063233B true CN107063233B (zh) | 2020-06-02 |
Family
ID=59603121
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710235275.7A Active CN107063233B (zh) | 2017-04-12 | 2017-04-12 | 基于惯性传感器的产线管控装置 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN107063233B (zh) |
Families Citing this family (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107664777A (zh) * | 2017-11-20 | 2018-02-06 | 中国地质科学院岩溶地质研究所 | 一种地下河管道三维轨迹探测器 |
CN108548520A (zh) * | 2018-02-25 | 2018-09-18 | 中国电信股份有限公司盐城分公司 | 一种基于nb-iot的天线姿态远程数据采集*** |
CN109724602A (zh) * | 2018-12-17 | 2019-05-07 | 南京理工大学 | 一种基于硬件fpu的姿态解算***及其解算方法 |
CN110292387B (zh) * | 2019-06-28 | 2022-05-27 | 广西慧云信息技术有限公司 | 一种统计农业工人工作效率的装置及统计方法 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101109959A (zh) * | 2007-08-06 | 2008-01-23 | 北京航空航天大学 | 一种适用于任意运动微小型***的定姿*** |
CN101546191A (zh) * | 2009-03-24 | 2009-09-30 | 苏添置 | 流水线作业数据采集及管控方法和*** |
CN101673449A (zh) * | 2009-10-16 | 2010-03-17 | 广东省科学院自动化工程研制中心 | 一种基于三维位置传感装置的工人动作检测及报警方法 |
CN105068654A (zh) * | 2015-08-14 | 2015-11-18 | 济南中景电子科技有限公司 | 基于can总线和惯性传感器的动作捕获***及方法 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
FR2870838B1 (fr) * | 2004-06-01 | 2006-07-07 | Rieter Textile Machinery Fr | Procede de pilotage des organes d'entrainement lineaire d'un produit filiforme notamment un fil textile pendant la phase de demarrage |
-
2017
- 2017-04-12 CN CN201710235275.7A patent/CN107063233B/zh active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101109959A (zh) * | 2007-08-06 | 2008-01-23 | 北京航空航天大学 | 一种适用于任意运动微小型***的定姿*** |
CN101546191A (zh) * | 2009-03-24 | 2009-09-30 | 苏添置 | 流水线作业数据采集及管控方法和*** |
CN101673449A (zh) * | 2009-10-16 | 2010-03-17 | 广东省科学院自动化工程研制中心 | 一种基于三维位置传感装置的工人动作检测及报警方法 |
CN105068654A (zh) * | 2015-08-14 | 2015-11-18 | 济南中景电子科技有限公司 | 基于can总线和惯性传感器的动作捕获***及方法 |
Also Published As
Publication number | Publication date |
---|---|
CN107063233A (zh) | 2017-08-18 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107063233B (zh) | 基于惯性传感器的产线管控装置 | |
CN108061855B (zh) | 一种基于mems传感器的球形电机转子位置检测方法 | |
WO2019000854A1 (zh) | 一种波浪补偿打捞机器人*** | |
CN103895022A (zh) | 穿戴式体感控制机械手 | |
CN102426477A (zh) | 一种手势侦测方法及侦测装置 | |
CN103894583A (zh) | 压铸六轴机械手的控制方法及压铸六轴机械手 | |
CN107923740A (zh) | 传感器设备、传感器***以及信息处理设备 | |
CN107263511A (zh) | 一种全向机场跑道检测机器人***及其控制方法 | |
CN112697131A (zh) | 基于视觉和惯性导航***的井下移动装备定位方法及*** | |
CN102024316A (zh) | 一种无线智能感测方法、装置及*** | |
CN112264996B (zh) | 一种抓钢机定位控制方法及*** | |
CN206095257U (zh) | 智能巡视机器人组合导航*** | |
CN106092053A (zh) | 一种机器人重复定位***及其定位方法 | |
CN108267139A (zh) | 一种agv小车的定位装置及定位方法 | |
CN110624217A (zh) | 一种基于多传感器融合的复健手套及其实现方法 | |
CN105425660A (zh) | 通过惯性传感器进行人体行为判断的分析匹配工作方法 | |
CN107024208A (zh) | 一种定位方法及其定位装置 | |
CN114714358A (zh) | 基于手势协议遥操作机械臂方法及*** | |
CN210302323U (zh) | 一种带有姿态传感器的户外骑行设备 | |
CN207007103U (zh) | 一种汽车前端模块支架的测量装置 | |
CN105302307A (zh) | 通过加速度传感器获取方向信息进行行为匹配的方法 | |
Bao et al. | Operation action recognition using wearable devices with inertial sensors | |
CN105259837A (zh) | 一种远程遥控门禁***的智能手环控制方法 | |
CN110186453A (zh) | 一种运动姿态数据的获取装置以及方法 | |
CN105243720B (zh) | 通过智能手环获取脉搏数据进行门禁安全身份识别的方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |