[发明专利]分体式云台的自动跟随控制系统及方法有效
| 申请号： | 201010238166.9 | 申请日： | 2010-07-28 |
| 公开（公告）号： | CN101916119A | 公开（公告）日： | 2010-12-15 |
| 发明（设计）人： | 王倩倩;陈大明;李鹏;夏立民;桑建国 | 申请（专利权）人： | 山东神戎电子股份有限公司 |
| 主分类号： | G05D3/12 | 分类号： | G05D3/12;G03B17/56 |
| 代理公司： | 济南舜源专利事务所有限公司 37205 | 代理人： | 闫晓燕 |
| 地址： | 250101 山东省济南市高新开*** | 国省代码： | 山东;37 |
| 权利要求书： | 查看更多 | 说明书： | 查看更多 |
| 摘要： | |||
| 搜索关键词： | 体式 自动 跟随 控制系统 方法 | ||
1.一种分体式云台的自动跟随控制系统及方法，其特征是，它包括主控云台和随动云台，主控云台和随动云台均设置有水平和俯仰机构，主控云台和随动云台的内置处理器均包含有控制模块；
首先，确定与目标水平面对应的联动数学模型中的系数：
(1)、当监控的所有目标处于同一水平面S1时，可以通过如下方法求得：手动控制并观测屏幕使主控云台和随动云台指向同一目标水平面上的一个具体目标时，主控云台的控制模块能够自动获取主控云台的水平转动角xx1和俯仰转动角xx2；随动云台的控制模块能够自动获取随动云台的水平转动角yy1和俯仰转动角yy2并将获得的水平转动角xx1、yy1和俯仰转动角xx2、yy2自动输入预置在随动云台处理器内的联动数学模型，获得联动数学模型中的系数h1，h2和d；
(2)、当主控云台和随动云台同时监控S1和与S1平行的水平面S2上的目标时，S1和S2水平面分别对应一个联动数学模型，测定主控云台到S2水平面上任意一个目标的距离l2，就能确定S2水平面的联动数学模型的系数：
h1′＝l2*sinxx2′，
h2′＝(h1′-h1)+h2，
其中h1′和h2′为S2水平面的联动数学模型的系数，xx2′是主控云台到S2水平面上的目标的俯仰转动角，该俯仰转动角能够通过控制模块自动获取，h1和h2是(1)中计算得到的S1水平面的联动数学模型的系数；
其次，联动数学模型中的系数确定后，当主控云台转动时，主控云台的控制模块能够自动获取主控云台的水平转动角x1和俯仰转动角x2；
随动云台处理器通过联动数学模型：
得到随动云台的水平转动角和俯仰转动角；
上述y1为随动云台的水平转动角，y2为随动云台的俯仰转动角；h1、h1′为主控云台到水平面的垂直距离；h2、h2′为随动云台到水平面的垂直距离；d为主控云台和随动云台之间的距离；a1和a2分别为主控云台和随动云台的水平偏角；b1和b2分别为主控云台和随动云台的俯仰偏角。
最后，随动云台的处理器根据得到的随动云台的水平转动角和俯仰转动角驱动随动云台的自动跟随动作使主控云台和随动云台目标一致。
2.根据权利要求1所述的分体式云台的自动跟随控制系统及方法，其特征是，所述的水平偏角a1和a2、俯仰偏角b1和b2可以通过校正手段消除，简化后的数学模型为：
该专利技术资料仅供研究查看技术是否侵权等信息，商用须获得专利权人授权。该专利全部权利属于山东神戎电子股份有限公司，未经山东神戎电子股份有限公司许可，擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作，请联系【客服】
本文链接：http://www.vipzhuanli.com/pat/books/201010238166.9/1.html，转载请声明来源钻瓜专利网。
