《一种云台垂直电机的驱动方法.pdf》由会员分享,可在线阅读,更多相关《一种云台垂直电机的驱动方法.pdf(5页完整版)》请在专利查询网上搜索。
1、(10)申请公布号 CN 103001563 A (43)申请公布日 2013.03.27 CN 103001563 A *CN103001563A* (21)申请号 201210497148.1 (22)申请日 2012.11.28 H02P 8/00(2006.01) (71)申请人 天津市亚安科技股份有限公司 地址 300384 天津市南开区华苑产业园区梓 苑路 8 号 (72)发明人 武付军 刘吉祥 (74)专利代理机构 天津市三利专利商标代理有 限公司 12107 代理人 闫俊芬 (54) 发明名称 一种云台垂直电机的驱动方法 (57) 摘要 本发明公开了一种云台垂直电机的驱动方 法。
2、, 包括以下步骤 : (1) 在接收到控制指令后先获 取得到目前云台垂直位置的角度值 ; (2) 获取当 前云台垂直运动状态标志位的数值以确定云台垂 直运动状态 ; (3) 根据垂直电机的驱动电流细分 表、 云台垂直位置的角度值以及云台垂直运动状 态重新生成新的驱动电流细分表 ; (4) 按照重新 生成的新的驱动电流细分表驱动垂直电机移动至 设定的垂直位置。本发明可结合云台垂直位置角 度与运动状态来更新电流细分表, 实现了垂直电 机力矩的灵活控制 ; 可实现垂直电机全角度范围 内, 力矩大小自适应 ; 有效的解决了以往云台在 电机力矩需求较高的位置及运动状态下电机丢 步、 甚至无法启动等情况。。
3、 (51)Int.Cl. 权利要求书 1 页 说明书 3 页 (19)中华人民共和国国家知识产权局 (12)发明专利申请 权利要求书 1 页 说明书 3 页 1/1 页 2 1. 一种云台垂直电机的驱动方法, 其特征在于, 包括以下步骤 : (1) 在接收到控制指令后先获取得到目前云台垂直位置的角度值 ; (2) 获取当前云台垂直运动状态标志位的数值以确定云台垂直运动状态 ; (3) 根据垂直电机的驱动电流细分表、 云台垂直位置的角度值以及云台垂直运动状态 重新生成新的驱动电流细分表 ; (4) 按照重新生成的新的驱动电流细分表驱动垂直电机移动至设定的垂直位置。 2.如权利要求1所述的驱动方法。
4、, 其特征在于, 所述的步骤3中重新生成新的驱动电流 细分表是指读取垂直电机的驱动电流细分表并乘以一个幅值调节因子 Afz(,z) 以生成新 的驱动电流细分表, 其中, Afz(,z)=A()B(z), 3.如权利要求1或2所述的驱动方法, 其特征在于, 所述的步骤1中云台角度值通过云 台最大垂直角度及其对应的最大电机步数和当前电机步数值来计算得出。 权 利 要 求 书 CN 103001563 A 2 1/3 页 3 一种云台垂直电机的驱动方法 技术领域 0001 本发明涉及视频监控技术领域, 特别是涉及一种根据云台位置与运动状态来控制 电机力矩的垂直电机驱动方法。 背景技术 0002 在安。
5、防监控领域中, 步进电机以其准确的位置控制, 低廉的成本、 简便快捷的操控 方式等诸多优点, 在云台监控系统水平及垂直方向的位置控制上, 有着十分广泛的应用, 担 当着监控系统角度控制的主流地位。而软件细分的驱动方式, 因其可使步进电机运行状态 更加平稳, 控制更加灵活, 被越来越多的开发人员所利用。 0003 但传统的软件细分方式, 未对驱动电流的幅值进行有效的灵活操控, 在传动结构 固定的情况下, 不可对电机输出力矩大小进行有效控制 ; 在安防监控领域中, 由于云台受到 重力影响, 造成垂直方向不同角度及不同运动状态所需要的电机力矩各不相同, 利用传统 细分方式进行驱动, 就会造成电机持续。
6、大力矩工作时, 会在力矩需求较低的位置及运动状 态下, 无谓的消耗功率, 使得垂直电机与驱动芯片发热, 降低部件使用寿命 ; 在电机持续小 力矩工作时, 会使得云台在电机力矩需求较高的位置及运动状态下电机丢步、 甚至无法启 动, 大大的降低了云台监控系统的监控质量。 发明内容 0004 本发明的目的是针对现有技术中存在的技术缺陷, 而提供一种运行平稳无丢步的 云台垂直电机的驱动方法。 0005 为实现本发明的目的所采用的技术方案是 : 0006 一种云台垂直电机的驱动方法, 包括以下步骤 : 0007 (1) 在接收到控制指令后先获取得到目前云台垂直位置的角度值 ; 0008 (2) 获取当前。
7、云台垂直运动状态标志位的数值以确定云台垂直运动状态 ; 0009 (3) 根据垂直电机的驱动电流细分表、 云台垂直位置的角度值以及云台垂直运动 状态重新生成新的驱动电流细分表 ; 0010 (4) 按照重新生成的新的驱动电流细分表驱动垂直电机移动至设定的垂直位置。 0011 所述的步骤 3 中重新生成新的驱动电流细分表是指读取垂直电机的驱动 电流细分表并乘以一个幅值调节因子 Afz(,z) 以生成新的驱动电流细分表, 其中, Afz(,z)=A()B(z)。 0012 所述的步骤 1 中云台角度值通过云台最大垂直角度及其对应的最大电机步数和 当前电机步数值来计算得出。 0013 与现有技术相比。
8、, 本发明的有益效果是 : 0014 本发明可结合云台垂直位置角度与运动状态来更新电流细分表, 实现了垂直电机 力矩的灵活控制 ; 实际应用中, 由于云台受到重力影响, 造成垂直方向不同角度及不同运动 状态所需要的电机力矩各不相同, 通过本发明, 便可实现垂直电机全角度范围内, 力矩大小 说 明 书 CN 103001563 A 3 2/3 页 4 自适应 ; 有效的解决了以往云台在电机力矩需求较高的位置及运动状态下电机丢步、 甚至 无法启动等情况, 并有效的降低了在力矩需求较低的位置及运动状态下功率的无谓消耗, 也可在一定程度上降低垂直电机与驱动芯片的发热量, 延长部件使用寿命 ; 具有降低。
9、功耗、 增强适应性、 应用简便等特点。 具体实施方式 0015 以下结合具体实施例对本发明作进一步详细说明。应当理解, 此处所描述的具体 实施例仅仅用以解释本发明, 并不用于限定本发明。 0016 本发明的根据云台位置与运动状态来控制电机力矩的方法, 包括以下步骤 : 0017 步骤 1 : 通过云台最大垂直角度及其对应的最大垂直电机步数和当前垂直电机步 数值来计算云台目前垂直角度信息 ; 这一步骤是在云台接到转动命令之后执行, 这种利用 程序计算得出当前角度信息的方法简便易行, 不用外加硬件电路来实时检测云台垂直角度 信息, 可节约成本。 0018 步骤 2 : 获取云台垂直运动状态标志位的。
10、数值以确定运动转动方向 ; 垂直运动状 态标志位是指代表云台垂直运动的方向, 包括向上、 向下和平动, 三种不同的垂直运动状态 决定三种不同的受力, 所以本发明将其区分出来赋以不同的幅值。 0019 步骤 3 : 读取垂直电机的驱动电流细分表并根据目前云台垂直位置的角度值与运 动状态重新生成新的驱动电流细分表, 即结合云台所处的位置和将要进行的运动重新生成 新的驱动电流细分表, 因为每次运动的起始位和方向各有不同, 所以根据实际情况重新生 成新的驱动电流细分表, 能更好地提高运动的电机驱动效果 ; 0020 步骤 4 : 由电机驱动电路按照重新生成的新的驱动电流细分表驱动电机工作, 电 机按照。
11、驱动电流细分表进行驱动, 实现电机平稳驱动, 利用驱动电流细分表驱动电机为现 有技术, 在此不再赘述 ; 0021 步骤 5 : 判断一个细分周期是否执行完成, 如果是, 则返回步骤 1 循环执行步骤 1 至步骤 4, 如果不是, 则返回步骤 4 继续按照当前的重新生成的新的驱动电流细分表执行。 具体来说, 在执行完一个细分周期后, 发送一个标志位, 通过标志位来判定该细分周期是否 执行完判断一个细分周期是否完成的主要原因是, 如果一个细分周期没有进行完的时候, 直接执行下一个细分表, 会造成电机运行不平稳, 如卡、 抖动或者丢步等 ; 0022 步骤 6 电机收到停止的指令, 停止转动, 其。
12、中当停止运动的时候电机内部的电流 为根据当前位置生成的固定值, 根据垂直角度 所对应的 A 值与静止状态时候的系数 B2 确定。 0023 具体地说, 其中, 步骤 1 角度值的计算公式为 : 0024 =max(M/Mmax) 0025 公式中 : max为云台垂直最大角度 ; M 为垂直电机当前步数 ; Mmax为云台垂直最大 角度对应的最大垂直电机步数。 0026 其中, 步骤 3 重新生成新的驱动电流细分表的步骤是根据云台垂直位置角度值与 运动状态, 进行相应的驱动电流细分表的电流进行幅值调节。由于一般传动装置的结构是 固定的, 故步进电机力矩大小主要取决于电机相电流的大小, 而细分曲。
13、线的幅值在很大程 度上会影响步进电机相电流的大小, 因此, 调节幅值可一定程度上起到调节电机力矩的作 说 明 书 CN 103001563 A 4 3/3 页 5 用, 这样可以满足不同运动需求。 0027 幅值调节因子的数学模型是 : 0028 Afz(,z)=A()B(z) (1) 0029 其中 A() 为幅值与垂直角度关系函数 ; B(z) 为垂直运动状态因子函数幅值与垂 直角度关系函数因式表达式为 : 0030 0031 运动状态因子函数因式表达式为 : 0032 0033 其中 z=-1 代表云台垂直向下运动 ; z=0 代表云台垂直方向静止 ; z=1 代表云台垂 直向上运动 ;。
14、 0034 需要说明的是, A1-An以及 B1、 B2、 B3是一组实验值或者经验值, 其根据不同的机型 或者设置环境而略有不同, 设置多大的角度区间以及如何设置上述各值, 可根据需求而进 行设置, 在此不进行赘述。 0035 对于本发明来说, 垂直电机的驱动电流细分表可采用任意形式的细分曲线, 如正 弦或者三角等, 本发明并不改变驱动电流细分表的细分形式, 仅是将细分表内细分数据读 出并进行幅值调节, 不需要硬件支持, 无需对现有装置做改进即可实现, 实现简单。垂直电 机重新生成的新的驱动电流细分表的确定可随着垂直角度信息 与当前云台垂直运动状 态 z 的变化而灵活改变, 从而使云台在不同垂直角度与运动状态下, 实现垂直电机力矩自 适应。 0036 以上所述仅是本发明的优选实施方式, 应当指出的是, 对于本技术领域的普通技 术人员来说, 在不脱离本发明原理的前提下, 还可以做出若干改进和润饰, 这些改进和润饰 也应视为本发明的保护范围。 说 明 书 CN 103001563 A 5 。