robotpic
23-12-2010, 03:25 PM
E VIẾT CHƯƠNG TRÌNH NHƯ SAU:
NHƯNG KHÔNG BIẾT SA CHỔ NÀO MÀ 2 CHÂN CCP1 CCP2 LUON LUON CÓ XUNG. DONG CƠ LUÔN CHAY KHI CẤP NGUỒN,
MONG MỌI NGƯỜI GIÚP ĐỠ
#INCLUDE <18F4331.h>
#INCLUDE <def_4331.h>
#FUSES HS,NOWDT,NOPROTECT,NOLVP,NOBROWNOUT,NOPUT
#FUSES NOCPD,NODEBUG,NOFCMEN,NOCPB,STVREN,PWMPIN,HPOL_LOW
#use delay(clock=20MHZ)
#use fast_io(a)
#use fast_io(d)
#use fast_io(c)
#use fast_io(e)
#INCLUDE <SCANF.C>
void main()
{
// DC7 - DC6(CCP1) - DC5(CCP1) - DC4(PWM7) -DC3(PWM1) - DC2(PWM3) - DC1(PWM5) //
///////////////////KICH ROLE CHIEU DC///////////////
trisc0=0; // role1
trisa1=0; // role2
trisa2=0; // role3
trisa3=0; // role4
trisa4=0; // role5
trisa5=0; // role6
trisb5=0; // role7
RC0=RA1=RA2=RA3=RA4=RA5=RB5=1;
////////////////// CHAN PWM DC///////////////////////////
TRISB4=0; // DC1 // PWM5
TRISB3=0; // DC2 // PWM3
TRISB1=0; // DC3 // PWM1
TRISD7=0; // DC4 // PWM7
TRISC1=0; // DC5 // CCP2
TRISC2=0; // DC6 // CCP1
TRISB2=0; // DC7 // BTHUONG_PWM2
/////////////////
// NUT AN DA KHAI BAO ROI///////////////////////////////////
TRISE0=0;
TRISE1=0;
TRISE2=0;
TRISD0=1; // GIAI MA 1
TRISD1=1; // GIAI MA 2
///////////////////////////////////////////////////////////
//pwm power
setup_power_pwm_pins( PWM_ODD_ON,PWM_ODD_ON,PWM_ODD_ON,PWM_ODD_ON);
setup_power_pwm(PWM_CLOCK_DIV_4|PWM_FREE_RUN,1,0,4 99,0,1, 0);
set_power_pwm_override(1, false, 0);
set_power_pwm_override(3, false, 0);
set_power_pwm_override(5, false, 0);
set_power_pwm_override(7, false, 0);
// ccp
setup_timer_2(T2_DIV_BY_4,124,1);
SETUP_CCP1(CCP_PWM);
SETUP_CCP2(CCP_PWM);
SET_PWM2_DUTY(125);
SET_PWM1_DUTY(125);
WHILE(1)
{
scan();
if(!nut1)
{
SET_POWER_PWM0_DUTY(400);
delay_ms(100);
set_power_pwm0_duty(0);
}
else if(!nut2)
{
SET_POWER_PWM2_DUTY(400);
delay_ms(100);
set_power_pwm2_duty(0);
}
else if(!nut3)
{
SET_POWER_PWM4_DUTY(500);
delay_ms(100);
set_power_pwm4_duty(0);
}
else if(!nut5)
{
SET_POWER_PWM6_DUTY(300);
delay_ms(100);
set_power_pwm6_duty(0);
}
else if(!nut6)
{
SET_PWM1_DUTY(0);
set_pwm2_duty(125);
delay_ms(100);
set_pwm1_duty(125);
}
else if(!nut11)
{
SET_PWM2_DUTY(60);
set_pwm1_duty(125);
delay_ms(100);
set_pwm2_duty(125);
}
else if(!nut12)
{
rb2=0;
delay_ms(100);
rb2=1;
}
}
}
NHƯNG KHÔNG BIẾT SA CHỔ NÀO MÀ 2 CHÂN CCP1 CCP2 LUON LUON CÓ XUNG. DONG CƠ LUÔN CHAY KHI CẤP NGUỒN,
MONG MỌI NGƯỜI GIÚP ĐỠ
#INCLUDE <18F4331.h>
#INCLUDE <def_4331.h>
#FUSES HS,NOWDT,NOPROTECT,NOLVP,NOBROWNOUT,NOPUT
#FUSES NOCPD,NODEBUG,NOFCMEN,NOCPB,STVREN,PWMPIN,HPOL_LOW
#use delay(clock=20MHZ)
#use fast_io(a)
#use fast_io(d)
#use fast_io(c)
#use fast_io(e)
#INCLUDE <SCANF.C>
void main()
{
// DC7 - DC6(CCP1) - DC5(CCP1) - DC4(PWM7) -DC3(PWM1) - DC2(PWM3) - DC1(PWM5) //
///////////////////KICH ROLE CHIEU DC///////////////
trisc0=0; // role1
trisa1=0; // role2
trisa2=0; // role3
trisa3=0; // role4
trisa4=0; // role5
trisa5=0; // role6
trisb5=0; // role7
RC0=RA1=RA2=RA3=RA4=RA5=RB5=1;
////////////////// CHAN PWM DC///////////////////////////
TRISB4=0; // DC1 // PWM5
TRISB3=0; // DC2 // PWM3
TRISB1=0; // DC3 // PWM1
TRISD7=0; // DC4 // PWM7
TRISC1=0; // DC5 // CCP2
TRISC2=0; // DC6 // CCP1
TRISB2=0; // DC7 // BTHUONG_PWM2
/////////////////
// NUT AN DA KHAI BAO ROI///////////////////////////////////
TRISE0=0;
TRISE1=0;
TRISE2=0;
TRISD0=1; // GIAI MA 1
TRISD1=1; // GIAI MA 2
///////////////////////////////////////////////////////////
//pwm power
setup_power_pwm_pins( PWM_ODD_ON,PWM_ODD_ON,PWM_ODD_ON,PWM_ODD_ON);
setup_power_pwm(PWM_CLOCK_DIV_4|PWM_FREE_RUN,1,0,4 99,0,1, 0);
set_power_pwm_override(1, false, 0);
set_power_pwm_override(3, false, 0);
set_power_pwm_override(5, false, 0);
set_power_pwm_override(7, false, 0);
// ccp
setup_timer_2(T2_DIV_BY_4,124,1);
SETUP_CCP1(CCP_PWM);
SETUP_CCP2(CCP_PWM);
SET_PWM2_DUTY(125);
SET_PWM1_DUTY(125);
WHILE(1)
{
scan();
if(!nut1)
{
SET_POWER_PWM0_DUTY(400);
delay_ms(100);
set_power_pwm0_duty(0);
}
else if(!nut2)
{
SET_POWER_PWM2_DUTY(400);
delay_ms(100);
set_power_pwm2_duty(0);
}
else if(!nut3)
{
SET_POWER_PWM4_DUTY(500);
delay_ms(100);
set_power_pwm4_duty(0);
}
else if(!nut5)
{
SET_POWER_PWM6_DUTY(300);
delay_ms(100);
set_power_pwm6_duty(0);
}
else if(!nut6)
{
SET_PWM1_DUTY(0);
set_pwm2_duty(125);
delay_ms(100);
set_pwm1_duty(125);
}
else if(!nut11)
{
SET_PWM2_DUTY(60);
set_pwm1_duty(125);
delay_ms(100);
set_pwm2_duty(125);
}
else if(!nut12)
{
rb2=0;
delay_ms(100);
rb2=1;
}
}
}