main.cpp

00001 // mRMCS04 Vr1,Vr2 control
00002 // mbed RailModelContorolSystem
00003 
00004 #include "mbed.h"
00005 #include "TextLCD0420.h"
00006 
00007 #define ON 1
00008 #define OFF 0
00009 #define XON 0
00010 #define XOFF 1
00011 
00012 DigitalOut mled1(LED1);
00013 DigitalOut mled2(LED2);
00014 DigitalOut mled3(LED3);
00015 DigitalOut mled4(LED4);
00016 AnalogIn vr1_adc(p15);
00017 AnalogIn vr2_adc(p16);
00018 DigitalIn sens1(p17);
00019 DigitalIn sens2(p18);
00020 DigitalIn sens3(p19);
00021 PwmOut r1_pwm(p22);
00022 PwmOut r2_pwm(p23);
00023 DigitalOut po10(p5);
00024 DigitalOut po11(p6);
00025 DigitalOut po20(p7);
00026 DigitalOut po21(p8);
00027 
00028 TextLCD lcd(p24, p25, p26, p27, p28, p29, p30,20,4); // rs, rw, e, d0, d1, d2, d3
00029 
00030 float pduty,pduty_slow;
00031 
00032 void notch(float duty){
00033   r1_pwm.write(duty);
00034   r2_pwm.write(0);
00035 }
00036 
00037 void r_notch(float duty){
00038   r1_pwm.write(0);
00039   r2_pwm.write(duty);
00040 }
00041 
00042 int main() {      
00043   int i;
00044   float pduty;
00045   r1_pwm.pulsewidth(0.000001);//1us=0.000001
00046   r1_pwm.period(0.00001);//1ms=0.001s
00047   r2_pwm.pulsewidth(0.000001);//1us=0.000001
00048   r2_pwm.period(0.00001);//1ms=0.001s
00049 
00050   
00051   lcd.cls();
00052   lcd.locate(0,0);
00053   lcd.printf("** mbed RMCS04 **");
00054   
00055   
00056   while(1){
00057     for(i=0;i<20;i++){
00058       pduty=vr1_adc.read();
00059       notch(pduty);
00060       lcd.locate(0,1);
00061       lcd.printf("Vr1:notch on=> %2d",20-i);
00062       wait(1.0);
00063     }
00064     notch(0);
00065     wait(3.0);
00066     for(i=0;i<20;i++){
00067       pduty=vr2_adc.read();
00068       r_notch(pduty);
00069       lcd.locate(0,2);
00070       lcd.printf("Vr2:r_notch on=>%2d",20-i);
00071       wait(1.0);
00072     }
00073     r_notch(0);
00074     wait(3.0);
00075   }//while
00076      
00077 }//main