ptz_pelcop.c

来自「1、基于韩国at2041芯片开发的Linux环境的DVR代码。 2、以原来代码」· C语言 代码 · 共 524 行

C
524 行
字号 
/* set tabstop=4 */
/********************************************************************************
 *                                                                              *
 * Copyright(C) 2004  Penta-Micro                                               *
 *                                                                              *
 * ALL RIGHT RESERVED                                                           *
 *                                                                              *
 * This software is the property of Penta-Micro and is furnished under          *
 * license by Penta-Micro. This software may be used only in accordance         *	
 * with the terms of said license. This copyright notice may not be             *
 * removed, modified or obliterated without the prior written permission        *
 * of Penta-Micro.                                                              *
 *                                                                              *
 * This software may not be copyed, transmitted, provided to or otherwise       *
 * made available to any other person, company, corporation	or other entity     *
 * except as specified in the terms of said license.                            *
 *                                                                              *
 * No right, title, ownership or other interest in the software is hereby       *
 * granted or transferred.                                                      *
 *                                                                              *
 * The information contained herein is subject to change without notice and     *
 * should not be construed as a commitment by Penta-Micro.                      *
 *                                                                              *
 ********************************************************************************
 
  MODULE NAME:  ptz_pelcop.c
  
  REVISION HISTORY:
  
  Date       Ver Name                  Description
  ---------- --- --------------------- -----------------------------------------
  07/09/2003 1.0 Mhpark                Created   
  02/01/2005 1.1 JiGwanKang(xchannel)  Modify(arrangement) 
 ...............................................................................
 
  DESCRIPTION:
  
  This Module contains functions for "PELCO P-Protocol" ptz model.
  
 ...............................................................................
*/  

/** ************************************************************************* ** 
 ** includes
 ** ************************************************************************* **/
#include <stdio.h>

#include "pthread_ptzctrl.h"

/** ************************************************************************* ** 
 ** defines
 ** ************************************************************************* **/
 
/** ************************************************************************* ** 
 ** typedefs
 ** ************************************************************************* **/
	 
/** ************************************************************************* ** 
 ** globals
 ** ************************************************************************* **/

/** ************************************************************************* ** 
 ** locals
 ** ************************************************************************* **/
BOOL	m_bPreset;
BOOL	m_bIris;
BOOL	m_bCamPower;
BOOL	m_bCamLight;
BOOL	m_bCamWiper;
BOOL	m_bCamAutorun;
BOOL	m_bCamAux;

BOOL	m_bAutorunStart;
BOOL	m_bAutorunStop;
BOOL	m_bPresetSpeed;
BOOL	m_bPTZSpeed;

BOOL	m_bMenu;
BOOL	m_bMenuUp;
BOOL	m_bMenuDown;
BOOL	m_bMenuValueUp;
BOOL	m_bMenuValueDown;

BOOL	m_bPatternSet;
BOOL	m_bPatternRun;

BOOL	m_bReset;

UNS8	m_STX_0;		// Fixed : 0xA0
UNS8	m_ADDR;		// Receiver Address ( 0x00 ~ 0x1F : Customer Documentation specifies 1 to 32 )
UNS8	m_DATA1;
UNS8	m_DATA2;
UNS8	m_DATA3;
UNS8	m_DATA4;
UNS8	m_ETX_0;		// Fixed : 0xAF
UNS8	m_CS;		// Check Sum

/** ************************************************************************* ** 
 ** forward declarations
 ** ************************************************************************* **/

static void GetModelInfo ( PTZInfo* pModelInfo )
{
	#ifdef PTZ_PelcoP
		strcpy ( pModelInfo->PTZModelName, PTZ_PelcoP );
	#endif
	pModelInfo->bPreset		= m_bPreset;
	pModelInfo->bIris		= m_bIris;
	pModelInfo->bCamAux		= m_bCamAux;
	pModelInfo->bMenu		= m_bMenu;
	pModelInfo->bCamPower		= m_bCamPower;
	pModelInfo->bCamLight		= m_bCamLight;
	pModelInfo->bCamWiper		= m_bCamWiper;
	pModelInfo->bCamAutorun		= m_bCamAutorun;
	pModelInfo->bAutorunStart	= m_bAutorunStart;
	pModelInfo->bAutorunStop	= m_bAutorunStop;
	pModelInfo->bPresetSpeed	= m_bPresetSpeed;
	pModelInfo->bPTZSpeed		= m_bPTZSpeed;
	pModelInfo->bMenuUp			= m_bMenuUp;
	pModelInfo->bMenuDown		= m_bMenuDown;
	pModelInfo->bMenuValueUp	= m_bMenuValueUp;
	pModelInfo->bMenuValueDown	= m_bMenuValueDown;
	pModelInfo->bPatternSet		= m_bPatternSet;
	pModelInfo->bPatternRun		= m_bPatternRun;
	pModelInfo->bReset			= m_bReset;
}


static void CalcCheckSumByte ()
{
	UNS16 val;

	val = m_STX_0 ^ m_ADDR ^ m_DATA1 ^ m_DATA2 ^ m_DATA3 ^ m_DATA4 ^ m_ETX_0;

	//m_CS = LOBYTE (val);
	m_CS = val & 0xff;
}
static BOOL SendCommand ()
{
	UNS8 buff[10];

	CalcCheckSumByte ();
		
	buff[0] = m_STX_0;
	buff[1] = m_ADDR;
	buff[2] = m_DATA1;
	buff[3] = m_DATA2;
	buff[4] = m_DATA3;
	buff[5] = m_DATA4;
	buff[6] = m_ETX_0;
	buff[7] = m_CS;
	
	#ifdef PTZ_PelcoP
		return SendComm(buff, 8, PTZ_PelcoP_ID);	
	#endif

	return TRUE;
}
static BOOL PanRight ( void *args )
{
	PTZ_STR *str_params = (PTZ_STR *)args ;
	
//	m_ADDR	= str_params->iCamID;
	m_DATA1 = 0x00;

	m_DATA2 = 0x02;
	m_DATA3 = (UNS8)(0x3f * str_params->iSpeed / 100.);
	m_DATA4 = 0x00;
	
	return SendCommand ();
}
static BOOL PanLeft ( void *args )
{
	PTZ_STR *str_params = (PTZ_STR *)args ;
	
//	m_ADDR	= str_params->iCamID;
	m_DATA1 = 0x00;

	m_DATA2 = 0x04;
	m_DATA3 = (UNS8)(0x3f * str_params->iSpeed / 100.);
	m_DATA4 = 0x00;
	
	return SendCommand ();
}
static BOOL TiltUp ( void *args )
{
	PTZ_STR *str_params = (PTZ_STR *)args ;
	
//	m_ADDR	= str_params->iCamID;
	m_DATA1 = 0x00;
	m_DATA2 = 0x08;
	m_DATA3 = 0x00;
	m_DATA4 = (UNS8)(0x3f * str_params->iSpeed / 100.);

	return SendCommand ();
}
static BOOL TiltDown ( void *args )
{
	PTZ_STR *str_params = (PTZ_STR *)args ;
	
//	m_ADDR	= str_params->iCamID;
	m_DATA1 = 0x00;
	m_DATA2 = 0x10;
	m_DATA3 = 0x00;
	m_DATA4 = (UNS8)(0x3f * str_params->iSpeed / 100.);

	return SendCommand ();
}
static BOOL UpLeft ( void *args )
{
	PTZ_STR *str_params = (PTZ_STR *)args ;
	
//	m_ADDR	= str_params->iCamID;
	m_DATA1 = 0x00;
	m_DATA2 = 0x0C;
	m_DATA3 = (UNS8)(0x3f * str_params->iSpeed / 100.);
	m_DATA4 = (UNS8)(0x3f * str_params->iSpeed / 100.);
	
	return SendCommand ();
}
static BOOL UpRight ( void *args )
{
	PTZ_STR *str_params = (PTZ_STR *)args ;
	
//	m_ADDR	= str_params->iCamID;
	m_DATA1 = 0x00;
	m_DATA2 = 0x0A;
	m_DATA3 = (UNS8)(0x3f * str_params->iSpeed / 100.);
	m_DATA4 = (UNS8)(0x3f * str_params->iSpeed / 100.);

	return SendCommand ();
}
static BOOL DownLeft ( void *args )
{
	PTZ_STR *str_params = (PTZ_STR *)args ;
	
//	m_ADDR	= str_params->iCamID;
	m_DATA1 = 0x00;
	m_DATA2 = 0x14;
	m_DATA3 = (UNS8)(0x3f * str_params->iSpeed / 100.);
	m_DATA4 = (UNS8)(0x3f * str_params->iSpeed / 100.);
	
	return SendCommand ();
}
static BOOL DownRight ( void *args )
{
	PTZ_STR *str_params = (PTZ_STR *)args ;
	
//	m_ADDR	= str_params->iCamID;
	m_DATA1 = 0x00;
	m_DATA2 = 0x12;
	m_DATA3 = (UNS8)(0x3f * str_params->iSpeed / 100.);
	m_DATA4 = (UNS8)(0x3f * str_params->iSpeed / 100.);

	return SendCommand ();
}
static BOOL PTZStop ( void *args )
{
	PTZ_STR *str_params = (PTZ_STR *)args ;
	
//	m_ADDR	= str_params->iCamID;
	m_DATA1 = 0x00;
	m_DATA2 = 0x00;
	m_DATA3 = 0x00;
	m_DATA4 = 0x00;
	return SendCommand ();
}
static BOOL ZoomIn ( void *args )
{
	PTZ_STR *str_params = (PTZ_STR *)args ;
	
//	m_ADDR	= str_params->iCamID;
	m_DATA1 = 0x00;
	m_DATA2 = 0x40;
	m_DATA3 = 0x00;
	m_DATA4 = 0x00;
	
	return SendCommand ();
}
static BOOL ZoomOut ( void *args )
{
	PTZ_STR *str_params = (PTZ_STR *)args ;
	
//	m_ADDR	= str_params->iCamID;
	m_DATA1 = 0x00;
	m_DATA2 = 0x20;
	m_DATA3 = 0x00;
	m_DATA4 = 0x00;
	return SendCommand ();
}
static BOOL FocusNear ( void *args )
{
	PTZ_STR *str_params = (PTZ_STR *)args ;
	
//	m_ADDR	= str_params->iCamID;
	m_DATA1 = 0x52;
	m_DATA2 = 0x00;
	m_DATA3 = 0x00;
	m_DATA4 = 0x00;
	return SendCommand ();
}
static BOOL FocusFar ( void *args )
{
	PTZ_STR *str_params = (PTZ_STR *)args ;
	
//	m_ADDR	= str_params->iCamID;
	m_DATA1 = 0x51;
	m_DATA2 = 0x00;
	m_DATA3 = 0x00;
	m_DATA4 = 0x00;
	
	return SendCommand ();
}
static BOOL IrisOpen ( void *args )
{
	PTZ_STR *str_params = (PTZ_STR *)args ;
	
//	m_ADDR	= str_params->iCamID;
	m_DATA1 = 0x54;
	m_DATA2 = 0x00;
	m_DATA3 = 0x00;
	m_DATA4 = 0x00;
	return SendCommand ();
}
static BOOL IrisClose ( void *args )
{
	PTZ_STR *str_params = (PTZ_STR *)args ;
	
//	m_ADDR	= str_params->iCamID;
	m_DATA1 = 0x58;
	m_DATA2 = 0x00;
	m_DATA3 = 0x00;
	m_DATA4 = 0x00;
	return SendCommand ();
}
static BOOL SetZoomSpeed	( void *args )
{
	PTZ_STR *str_params = (PTZ_STR *)args ;
	
//	m_ADDR	= str_params->iCamID;
	m_DATA1 = 0x00;
	m_DATA2 = 0x25;
	m_DATA3 = 0x00;
	m_DATA4 = (UNS8)(0x3f * str_params->iSpeed / 100.);

	return SendCommand ();
}
static BOOL SetFocusSpeed	( void *args )
{
	PTZ_STR *str_params = (PTZ_STR *)args ;
	
//	m_ADDR	= str_params->iCamID;
	m_DATA1 = 0x00;
	m_DATA2 = 0x27;
	m_DATA3 = 0x00;
	m_DATA4 = (UNS8)(0x3f * str_params->iSpeed / 100.);

	return SendCommand ();
}
static BOOL AutoScan ( void *args )
{
	PTZ_STR *str_params = (PTZ_STR *)args ;
	
//	m_ADDR	= str_params->iCamID;
	if ( str_params->bEnable )	
		m_DATA1 = 0x70;
	else
		m_DATA1 = 0x50;		
	m_DATA2 = 0x00;
	m_DATA3 = 0x00;
	m_DATA4 = 0x00;
	return SendCommand ();
}
static BOOL SetPreset	( void *args )
{
	PTZ_STR *str_params = (PTZ_STR *)args ;
	
//	m_ADDR	= str_params->iCamID;
	m_DATA1 = 0x00;
	m_DATA2 = 0x03;
	m_DATA3 = 0x00;
	m_DATA4 = str_params->No;		// Preset Number
	return SendCommand ();
}
static BOOL ClearPreset( void *args )
{
	PTZ_STR *str_params = (PTZ_STR *)args ;
	
//	m_ADDR	= str_params->iCamID;
	m_DATA1 = 0x00;
	m_DATA2 = 0x05;
	m_DATA3 = 0x00;
	m_DATA4 = str_params->No;
	return SendCommand ();
}
static BOOL GotoPreset ( void *args )
{
	PTZ_STR *str_params = (PTZ_STR *)args ;
	
//	m_ADDR	= str_params->iCamID;
	m_DATA1 = 0x00;
	m_DATA2 = 0x07;
	m_DATA3 = 0x00;
	m_DATA4 = str_params->No;
	return SendCommand ();
}
//////////////////////////////////////////////////////////////////////
static BOOL PatternSet ( void *args )
{
	PTZ_STR *str_params = (PTZ_STR *)args ;
	
	// Not Number, Possible Save Pattern is Only One!
//	m_ADDR		= str_params->iCamID;
	m_DATA1		= 0x00;
	if( str_params->bEnable )
		m_DATA2	= 0x1F;
	else
		m_DATA2	= 0x21;
	m_DATA3		= 0x00;
	m_DATA4		= 0x00;

	
	return SendCommand ();
}
//////////////////////////////////////////////////////////////////////
static BOOL PatternRun ( void *args )
{
	PTZ_STR *str_params = (PTZ_STR *)args ;
	
//	m_ADDR		= str_params->iCamID;
	m_DATA1		= 0x00;

	if( str_params->bEnable )
		m_DATA2		= 0x23;
	else
	{	
		str_params->iSpeed=10;
		TiltUp( (PTZ_STR *)str_params );
		PTZStop( (PTZ_STR *)str_params );
	}
	m_DATA3		= 0x00;
	m_DATA4		= 0x00;

	
	return SendCommand ();
}
static BOOL OSDMenu ( void *args )
{
	PTZ_STR *str_params = (PTZ_STR *)args ;
	
//	m_ADDR		= str_params->iCamID;
	m_DATA1		= 0x00;

	if ( str_params->bEnable )
		m_DATA2		= 0x09;
	else
		m_DATA2		= 0x0B;

	m_DATA3		= 0x00;
	m_DATA4		= 0x01;

	
	return SendCommand ();
}

void CPelcoP()
{
	m_bPreset		= TRUE;
	m_bIris			= TRUE;
	m_bCamPower	= TRUE;
	m_bCamLight	= FALSE;
	m_bCamWiper	= FALSE;
	m_bCamAutorun	= TRUE;
	m_bCamAux		= FALSE;

	m_bAutorunStart	= FALSE;
	m_bAutorunStop	= FALSE;
	m_bPresetSpeed	= FALSE;
	m_bPTZSpeed	= TRUE;

	m_bMenu		= FALSE;
	m_bMenuUp		= FALSE;
	m_bMenuDown	= FALSE;
	m_bMenuValueUp= FALSE;
	m_bMenuValueDown= FALSE;

	m_bPatternSet	= TRUE;
	m_bPatternRun	= TRUE;

	m_bReset		= FALSE;

	m_STX_0		= 0xA0;		// Start Transmission	- Fixed
	m_ADDR		= 0x00;		// Camera ID		- Base Camera ID 00 ~
	m_DATA1		= 0x00;
	m_DATA2		= 0x00;
	m_DATA3		= 0x00;
	m_DATA4		= 0x00;
	m_ETX_0		= 0xAF;		// End Transmission - Fixed
	m_CS			= 0x00;		// Check Sum
	
	ptz_status_struct.isr_table[PTZFSTOP].isr_ptr = PTZStop;
	ptz_status_struct.isr_table[PTUP].isr_ptr = TiltUp;
	ptz_status_struct.isr_table[PTDOWN].isr_ptr = TiltDown;
	ptz_status_struct.isr_table[PTZFSTOP].isr_ptr = PTZStop;
	ptz_status_struct.isr_table[PTLEFT].isr_ptr = PanLeft;
	ptz_status_struct.isr_table[PTRIGHT].isr_ptr = PanRight;
	ptz_status_struct.isr_table[PTZFSTOP].isr_ptr = PTZStop;
	ptz_status_struct.isr_table[ZIN].isr_ptr = ZoomIn;
	ptz_status_struct.isr_table[ZOUT].isr_ptr = ZoomOut;
	ptz_status_struct.isr_table[PTZFSTOP].isr_ptr = PTZStop;
	ptz_status_struct.isr_table[FIN].isr_ptr = FocusNear;
	ptz_status_struct.isr_table[FOUT].isr_ptr = FocusFar;
	ptz_status_struct.isr_table[SETPRESET].isr_ptr = SetPreset;
	ptz_status_struct.isr_table[GOTOPRESET].isr_ptr = GotoPreset;
	ptz_status_struct.isr_table[CLEARPRESET].isr_ptr = ClearPreset;
	ptz_status_struct.isr_table[IRISOPEN].isr_ptr = IrisOpen;
	ptz_status_struct.isr_table[IRISCLOSE].isr_ptr = IrisClose;
	ptz_status_struct.isr_table[AUTOPAN].isr_ptr = AutoScan;
	ptz_status_struct.isr_table[UPLEFT].isr_ptr = UpLeft;
	ptz_status_struct.isr_table[UPRIGHT].isr_ptr = UpRight;
	ptz_status_struct.isr_table[DOWNLEFT].isr_ptr = DownLeft;
	ptz_status_struct.isr_table[DOWNRIGHT].isr_ptr = DownRight;	
}

ptz_pelcop.c - 源码说明

本页面展示了「1、基于韩国at2041芯片开发的Linux环境的DVR代码。 2、以原来代码进行了修改。 3、主要修改网络通讯出现异常问题处理 4、硬盘覆盖录像不起作用」中的 ptz_pelcop.c 源码文件，采用 C语言 编程语言编写，共 524 行代码。您可以在线阅读完整代码内容，也可以返回资源详情页下载完整源码包进行本地学习和开发。

虫虫开发者社区收录了大量与DVR相关的技术资源，包括源代码、技术文档、电路图等，是电子工程师和嵌入式开发者的专业学习平台。

⌨️ 快捷键说明

复制代码Ctrl + C
搜索代码Ctrl + F
全屏模式F11
增大字号Ctrl + =
减小字号Ctrl + -
显示快捷键?