sm5000chip.cpp

来自「一个很好的VC++程序」· C++ 代码 · 共 155 行

/*
**	FILENAME			CSm5000Chip.cpp
**
*/

#include "stdafx.h"
#include "sm5000chip.h"

CSm5000Chip::CSm5000Chip()
{														 
	int i;
	for(i=0;i<4;i++)
	{
		m_WR1[i] =0;
		m_WR2[i] =0;
		m_WR3[i] =0;
	}
		m_WR4 = 0;	
		m_WR5 = 0;	
}

CSm5000Chip::~CSm5000Chip()
{														 
}

int  CSm5000Chip::GetReg(int RegNo, int AxisNo)
{
	int result;

	switch(RegNo)
	{
	case 1 : result = m_WR1[AxisNo];break;
	case 2 : result = m_WR2[AxisNo];break;
	case 3 : result = m_WR3[AxisNo];break;
	case 4 : result = m_WR4;break;
	case 5 : result = m_WR5;break;
	default: result = 0;break;
	}
	
	return result;
}

int  CSm5000Chip::GetWR1(int AxisNo)
{
	return m_WR1[AxisNo];
}

int  CSm5000Chip::GetWR2(int AxisNo)
{
	return m_WR2[AxisNo];
}

int  CSm5000Chip::GetWR3(int AxisNo)
{
	return m_WR3[AxisNo];
}

int  CSm5000Chip::GetWR4()
{
	return m_WR4;
}

int  CSm5000Chip::GetWR5()
{
	return m_WR5;
}

void CSm5000Chip::SetReg(int RegNo, int Value, int *AxisArray)
{														 
	int i;
	if(RegNo==1)
	{
	  for(i=0;i<4;i++)
		if(AxisArray[i])
			m_WR1[i] = Value;	
	}
	else if(RegNo==2)
	{
	  for(i=0;i<4;i++)
		if(AxisArray[i])
			m_WR2[i] = Value;	
	}
	else if(RegNo==3)
	{
	  for(i=0;i<4;i++)
		if(AxisArray[i])
			m_WR3[i] = Value;	
	}
	else if(RegNo==4)
		m_WR4 = Value;	
	else if(RegNo==5)
		m_WR5 = Value;	
}

void CSm5000Chip::SetReg(int RegNo, int Value, int AxisNo)
{														 
	if(RegNo==1)
		m_WR1[AxisNo] = Value;	
	else if(RegNo==2)
		m_WR2[AxisNo] = Value;	
	else if(RegNo==3)
		m_WR3[AxisNo] = Value;	
	else if(RegNo==4)
		m_WR4 = Value;	
	else if(RegNo==5)
		m_WR5 = Value;	
}

void CSm5000Chip::SetReg(int RegNo, int Value)
{														 
	if(RegNo==4)
		m_WR4 = Value;	
	else if(RegNo==5)
		m_WR5 = Value;	
}

void CSm5000Chip::SetWR1(int Value, int *AxisArray)
{														 
	int i;
	for(i=0;i<4;i++)
		if(AxisArray[i])
			m_WR1[i] = Value;	
}

void CSm5000Chip::SetWR2(int Value, int *AxisArray)
{														 
	int i;
	for(i=0;i<4;i++)
		if(AxisArray[i])
			m_WR2[i] = Value;	
}

void CSm5000Chip::SetWR3(int Value, int *AxisArray)
{														 
	int i;
	for(i=0;i<4;i++)
		if(AxisArray[i])
			m_WR3[i] = Value;	
}

void CSm5000Chip::SetWR4(int Value)
{														 
	m_WR4 = Value;	
}

void CSm5000Chip::SetWR5(int Value)
{														 
	m_WR5 = Value;	
}