📄 example_280xadcsoc.c
字号:
//###########################################################################
//
// FILE: Example_280xAdc.c
//
// TITLE: DSP280x ADC Example Program.
//
// ASSUMPTIONS:
//###########################################################################
#include "DSP280x_Device.h" // DSP280x Headerfile Include File
#include "DSP280x_Examples.h" // DSP280x Examples Include File
// Prototype statements for functions found within this file.
interrupt void adc_isr(void);
// Global variables used in this example:
Uint16 ConversionCount;
Uint16 Voltage1[128],Voltage3[128];
Uint16 I_SUM,I_SUM_SUM=0,I_SUM_PJ=0,I_SUM_n[8]={0,0,0,0,0,0,0,0},I_SUM_cnt=0,I_SUM_test=0; //马达电流
Uint32 I_SUM128=0;
Uint16 U_SUM; //直流电压
Uint32 U_SUM128=0;
Uint16 MOTOR_COUNT=0,MOTOR_ADJ=0,MOTOR_ADJ_s60s90=0;//马达速度控制电压
Uint32 M_U=0;
Uint32 MOTOR_SUM128=0,MOTOR_SUM=0;
Uint16 Uint16Emf1,Uint16Emf2=0;
Uint16 Uint16Motor,Uint16Motor_ERR;
Uint16 EPWM1_CMPA,emf_count,emf_flag,PWM_TEMP=0;
Uint16 MT_325=50;
Uint32 LED_COUNT=0;
Uint16 MAX_COUNT=0,U_SUM_SUM=0,U_SUM_PJ=0;
Uint16 M_U_PJ=0,M_U_SUM=0,M_U_COUNT=0,PWM_U=0,PWM_U_TEMP=0;
Uint16 PWM_RJ=0;
Uint16 Uart_err_flag=0,Uart_err_count=0,UART_COUNT=0;
Uint16 S90_DSP_V=0;//S90电马达速度
Uint16 run_start_flag=0,run_exe_flag=0;
Uint16 rqd_temp=0;//run_start_flag
// Global variables
Uint16 sdataA;
Uint16 rdataA[4]={0,0,0,0}; // Received data for SCI-A
Uint16 txdaddr=0,TXD_FLAG=0;
Uint16 TXD_COUNT=0,err_count=0;
Uint32 temp_adj=0;
Uint16 mot128_v=0;
Uint16 mot_ctl_flag=0;
Uint16 test=30;
Uint32 WD_RELAY;
Uint16 WD_FLAG;
void cal_dc_in_vol(void); //--计算输入直流电压--
void S60_S90_QF(void);
//--------运行开始标志----
void run_start(void);
void InitGpio(void);
void LED_EXE(void);
//--------------------------------
//---保护投入标志--
struct PROTECT_FLAG_BITS{
Uint16 SAMP_flag:1; //1 采样标志位
Uint16 FAULT_flag:1; //1 采样标志位
Uint16 A1_flag:1; //A1标志位
Uint16 S60_S90_flag:1; //A2标志位
Uint16 soft_run_flag:1;//软启动标志位
Uint16 stop_run_flag:1;//软启动标志位
Uint16 YX_run_flag:1; //允许启动标志位
Uint16 YX_exe_flag:1; //允许启动标志位
Uint16 run_start_flag:1; //允许启动标志位
Uint16 run_jc_flag:1; //允许启动标志位
Uint16 pwm_js_flag:1; //允许启动标志位
Uint16 DZ_ReadErr_flag:1; //reserved //yxl 2007-3-24
Uint16 txd_led_flag:1;
};
union PROTECT_FLAG_REG{
Uint16 all;
struct PROTECT_FLAG_BITS bit;
}PROTECT_FLAG_reg;
//----增加PWM部分定义---
typedef struct
{
volatile struct EPWM_REGS *EPwmRegHandle;
Uint16 EPwm_CMPA_Direction;
Uint16 EPwm_CMPB_Direction;
Uint16 EPwmTimerIntCount;
Uint16 EPwmMaxCMPA;
Uint16 EPwmMinCMPA;
Uint16 EPwmMaxCMPB;
Uint16 EPwmMinCMPB;
}EPWM_INFO;
// Prototype statements for functions found within this file.
void InitEPwm1Example(void);
void InitEPwm2Example(void);
//void InitEPwm3Example(void);
interrupt void epwm1_isr(void);
interrupt void epwm2_isr(void);
//interrupt void epwm3_isr(void);
//void update_compare(EPWM_INFO*);
// Global variables used in this example
EPWM_INFO epwm1_info;
EPWM_INFO epwm2_info;
//EPWM_INFO epwm3_info;
// Configure the period for each timer
#define EPWM1_TIMER_TBPRD 2500 // Period register
#define EPWM1_MAX_CMPA 900
#define EPWM1_MIN_CMPA 900
#define EPWM1_MAX_CMPB 900
#define EPWM1_MIN_CMPB 900
#define EPWM2_TIMER_TBPRD 2500 // Period register
#define EPWM2_MAX_CMPA 1750
#define EPWM2_MIN_CMPA 1750
#define EPWM2_MAX_CMPB 1750
#define EPWM2_MIN_CMPB 1750
#define EPWM3_TIMER_TBPRD 2000 // Period register
#define EPWM3_MAX_CMPA 950
#define EPWM3_MIN_CMPA 50
#define EPWM3_MAX_CMPB 1950
#define EPWM3_MIN_CMPB 1050
// To keep track of which way the compare value is moving
#define EPWM_CMP_UP 1
#define EPWM_CMP_DOWN 0
//=============================================================
void motor_ctrl_9(void);
void motor_ctrl_8(void);
void motor_ctrl_7(void);
void motor_ctrl_6(void);
void motor_ctrl_5(void);
void motor_ctrl_4_1(void);
void motor_ctrl_4(void);
void motor_ctrl_3(void);
void motor_ctrl_2(void);
void motor_ctrl_1(void);
//---------------------------
Uint16 rqd_flag=0;//2008-9-22
//================================================================================
main()
{
//Uint16 i;
InitSysCtrl();
// For this example, set HSPCLK to SYSCLKOUT / 8 (12.5Mhz assuming 100Mhz SYSCLKOUT)
EALLOW;
SysCtrlRegs.HISPCP.all = 0x4; // HSPCLK = SYSCLKOUT/8
EDIS;
DINT;
InitPieCtrl();
// Disable CPU interrupts and clear all CPU interrupt flags:
IER = 0x0000;
IFR = 0x0000;
//----------------
MemCopy(&RamfuncsLoadStart, &RamfuncsLoadEnd, &RamfuncsRunStart);
InitFlash();
InitPieVectTable();
EPwm1Regs.AQCSFRC.bit.CSFA =0x01;
EALLOW; // This is needed to write to EALLOW protected register
PieVectTable.ADCINT = &adc_isr;
//---增加ePWM部分-----
PieVectTable.EPWM1_INT = &epwm1_isr;
PieVectTable.EPWM2_INT = &epwm2_isr;
// PieVectTable.EPWM3_INT = &epwm3_isr;
//----
EDIS; // This is needed to disable write to EALLOW protected registers
//----------------------------------------------------
// For this example, only initialize the ePWM
EALLOW;
SysCtrlRegs.PCLKCR0.bit.TBCLKSYNC = 0;
EDIS;
InitEPwm1Gpio();
//InitEPwm2Gpio();
//InitEPwm3Gpio();
InitEPwm1Example();
//InitEPwm2Example();
// InitEPwm3Example();
EALLOW;
SysCtrlRegs.PCLKCR0.bit.TBCLKSYNC = 1;
EDIS;
// Step 5. User specific code, enable interrupts:
// Enable CPU INT3 which is connected to EPWM1-3 INT:
IER |= M_INT3;
// Enable EPWM INTn in the PIE: Group 3 interrupt 1-3
PieCtrlRegs.PIEIER3.bit.INTx1 = 1;
PieCtrlRegs.PIEIER3.bit.INTx2 = 1;
PieCtrlRegs.PIEIER3.bit.INTx3 = 1;
//----------------------------------------------------
InitAdc(); // For this example, init the ADC
PieCtrlRegs.PIEIER1.bit.INTx6 = 1;
IER |= M_INT1; // Enable CPU Interrupt 1
ConversionCount = 0;
//EPwm1Regs.CMPA.half.CMPA = 0x0080; // Set compare A value
//EPwm1Regs.TBPRD = 0xFFFF; // Set period for ePWM1
//EPwm1Regs.TBCTL.bit.CTRMODE = 0; // count up and start
EPwm1Regs.TBCTL.bit.CTRMODE = TB_COUNT_UP; // Count up
EPwm2Regs.TBCTL.bit.CTRMODE = TB_COUNT_UP; // Count up
Uint16Motor=0;
EPWM1_CMPA=0;
//-------------------------------------------
InitGpio();
//DSP28x_usDelay(500);
emf_flag=0;
emf_count=0;
GpioDataRegs.GPASET.bit.GPIO2=1;
PROTECT_FLAG_reg.bit.SAMP_flag=0;
PROTECT_FLAG_reg.bit.FAULT_flag=0;
GpioDataRegs.GPACLEAR.bit.GPIO5=1;
EPwm1Regs.AQCSFRC.bit.CSFA =0x01;
//--读GPIO6-9--
asm(" nop");asm(" nop");asm(" nop");
PROTECT_FLAG_reg.bit.A1_flag =GpioDataRegs.GPADAT.bit.GPIO6;
asm(" nop");asm(" nop");asm(" nop");
PROTECT_FLAG_reg.bit.S60_S90_flag =GpioDataRegs.GPADAT.bit.GPIO7;
PROTECT_FLAG_reg.bit.soft_run_flag=0;
PROTECT_FLAG_reg.bit.stop_run_flag=1;
PROTECT_FLAG_reg.bit.YX_run_flag=1;
PROTECT_FLAG_reg.bit.YX_exe_flag=1;
PROTECT_FLAG_reg.bit.run_start_flag=0;
PROTECT_FLAG_reg.bit.run_jc_flag=0;
//PROTECT_FLAG_reg.bit.pw
//-------------------
// Reset the watchdog counter
//////ServiceDog();
if(WD_FLAG==0xaa55)
WD_RELAY=20;
else
WD_RELAY=20000000;
DSP28x_usDelay(WD_RELAY);
//DSP28x_usDelay(WD_RELAY);
WD_FLAG=0xaa55;
InitSci();
// Enable the watchdog
EALLOW;
SysCtrlRegs.WDCR = 0x0028;
EDIS;
EINT; // Enable Global interrupt INTM
ERTM; // Enable Global realtime interrupt DBGM
//-------------------------------------------
for(;;)
{
// Reset the watchdog counter
//ServiceDog();
asm(" nop");
LED_EXE();
//--------------------------------------------
run_start();
//--计算输入直流电压--
cal_dc_in_vol();
//-----
}
}
//--------------------------------------------
interrupt void adc_isr(void)
{
Uint16 i,temp_i,TEMP2,temp3;
Uint32 temp;
ServiceDog();
LED_COUNT++;
if(LED_COUNT>16000)
LED_COUNT=0;
Voltage1[ConversionCount]=AdcRegs.ADCRESULT0 >>4;
// Voltage2[ConversionCount]=AdcRegs.ADCRESULT1 >>4;
Voltage3[ConversionCount]=AdcRegs.ADCRESULT2 >>4;
// Voltage4[ConversionCount]=AdcRegs.ADCRESULT3 >>4;
//-----
if(Voltage1[ConversionCount]>10)
Voltage1[ConversionCount]=Voltage1[ConversionCount]-10;
else
Voltage1[ConversionCount]=0;
//-----
if(Voltage3[ConversionCount]>22)
Voltage3[ConversionCount]=Voltage3[ConversionCount]-22;
else
Voltage3[ConversionCount]=0;
I_SUM128+=AdcRegs.ADCRESULT1 >>4;
U_SUM128+=Voltage3[ConversionCount];
MOTOR_SUM128+=AdcRegs.ADCRESULT3 >>4;
//----------------------------------------------------------
if(PROTECT_FLAG_reg.bit.run_start_flag==1)
{
EPwm1Regs.AQCSFRC.bit.CSFA =0x01;
}
else
{
if(ConversionCount==MT_325)
{
EPwm1Regs.AQCSFRC.bit.CSFA =0x01;
}
if(ConversionCount==0)
{
if(MOTOR_ADJ<6)
EPwm1Regs.AQCSFRC.bit.CSFA =0x01;
else
EPwm1Regs.AQCSFRC.bit.CSFA =0x00;
}
}
//--------------------------------------
if(PROTECT_FLAG_reg.bit.S60_S90_flag==1)//mc3
{
if(MOTOR_ADJ_s60s90==0)
EPwm1Regs.AQCSFRC.bit.CSFA =0x01;
}
//----------------------------------------------------------
//if(ConversionCount ==127)
// If 40 conversions have been logged, start over
if(ConversionCount == 127)
{
//---12-13--------------
// Reset the watchdog counter
////ServiceDog();
//----------------------
if(TXD_COUNT==31)
{
if(Uart_err_flag==0)
{
S90_DSP_V=((rdataA[0]<<8)+(rdataA[1]&0xff));//S90电马达速度
err_count=0;
}
else
{
err_count++;
if(err_count>3)
{
err_count=0;
S90_DSP_V=0;//S90电马达速度
}
}
txdaddr=0;
SciaRegs.SCITXBUF=0x55; // Send data
TXD_COUNT=0;
Uart_err_flag=1;
if(PROTECT_FLAG_reg.bit.txd_led_flag==1)
{
GpioDataRegs.GPASET.bit.GPIO13=1;
PROTECT_FLAG_reg.bit.txd_led_flag=0;
}
else
{
GpioDataRegs.GPACLEAR.bit.GPIO13=1;
PROTECT_FLAG_reg.bit.txd_led_flag=1;
}
}
else
TXD_COUNT++;
//-----------------------------------
ConversionCount = 0;
// EPwm1Regs.AQCSFRC.bit.CSFA =0x01;
PROTECT_FLAG_reg.bit.SAMP_flag=1;
MOTOR_SUM+=MOTOR_SUM128>>7;//
MOTOR_SUM128=0;
MOTOR_COUNT++;
//--
if(MOTOR_COUNT>15)
{
MOTOR_COUNT=0;
// if(MOTOR_SUM<8000)
temp3=MOTOR_SUM>>4;
if(temp3>50)
{
if(temp3<2001)
MOTOR_ADJ_s60s90=temp3-50;
else
MOTOR_ADJ_s60s90=(temp3+176)*10;
}
else
MOTOR_ADJ_s60s90=0;
// else
// MOTOR_ADJ_s60s90=MOTOR_SUM/5;
//--
MOTOR_SUM=0;
}
//--
U_SUM=U_SUM128/819;
U_SUM128=0;
MAX_COUNT++;
⌨️ 快捷键说明
复制代码
Ctrl + C
搜索代码
Ctrl + F
全屏模式
F11
切换主题
Ctrl + Shift + D
显示快捷键
?
增大字号
Ctrl + =
减小字号
Ctrl + -