main.cpp@0:11d2a936a858, 2012-01-19 (annotated)
- Committer:
- takeuchi
- Date:
- Thu Jan 19 01:03:28 2012 +0000
- Revision:
- 0:11d2a936a858
Who changed what in which revision?
| User | Revision | Line number | New contents of line |
|---|---|---|---|
| takeuchi | 0:11d2a936a858 | 1 | // mRMCS07 sens1 hanten |
| takeuchi | 0:11d2a936a858 | 2 | // mbed RailModelContorolSystem |
| takeuchi | 0:11d2a936a858 | 3 | |
| takeuchi | 0:11d2a936a858 | 4 | #include "mbed.h" |
| takeuchi | 0:11d2a936a858 | 5 | #include "TextLCD0420.h" |
| takeuchi | 0:11d2a936a858 | 6 | |
| takeuchi | 0:11d2a936a858 | 7 | #define ON 1 |
| takeuchi | 0:11d2a936a858 | 8 | #define OFF 0 |
| takeuchi | 0:11d2a936a858 | 9 | #define XON 0 |
| takeuchi | 0:11d2a936a858 | 10 | #define XOFF 1 |
| takeuchi | 0:11d2a936a858 | 11 | |
| takeuchi | 0:11d2a936a858 | 12 | DigitalOut mled1(LED1); |
| takeuchi | 0:11d2a936a858 | 13 | DigitalOut mled2(LED2); |
| takeuchi | 0:11d2a936a858 | 14 | DigitalOut mled3(LED3); |
| takeuchi | 0:11d2a936a858 | 15 | DigitalOut mled4(LED4); |
| takeuchi | 0:11d2a936a858 | 16 | AnalogIn vr1_adc(p15); |
| takeuchi | 0:11d2a936a858 | 17 | AnalogIn vr2_adc(p16); |
| takeuchi | 0:11d2a936a858 | 18 | DigitalIn sens1(p17); |
| takeuchi | 0:11d2a936a858 | 19 | DigitalIn sens2(p18); |
| takeuchi | 0:11d2a936a858 | 20 | DigitalIn sens3(p19); |
| takeuchi | 0:11d2a936a858 | 21 | PwmOut r1_pwm(p22); |
| takeuchi | 0:11d2a936a858 | 22 | PwmOut r2_pwm(p23); |
| takeuchi | 0:11d2a936a858 | 23 | DigitalOut po10(p5); |
| takeuchi | 0:11d2a936a858 | 24 | DigitalOut po11(p6); |
| takeuchi | 0:11d2a936a858 | 25 | DigitalOut po20(p7); |
| takeuchi | 0:11d2a936a858 | 26 | DigitalOut po21(p8); |
| takeuchi | 0:11d2a936a858 | 27 | |
| takeuchi | 0:11d2a936a858 | 28 | TextLCD lcd(p24, p25, p26, p27, p28, p29, p30,20,4); // rs, rw, e, d0, d1, d2, d3 |
| takeuchi | 0:11d2a936a858 | 29 | |
| takeuchi | 0:11d2a936a858 | 30 | float pduty,pduty_slow; |
| takeuchi | 0:11d2a936a858 | 31 | |
| takeuchi | 0:11d2a936a858 | 32 | void notch(float duty){ |
| takeuchi | 0:11d2a936a858 | 33 | r1_pwm.write(duty); |
| takeuchi | 0:11d2a936a858 | 34 | r2_pwm.write(0); |
| takeuchi | 0:11d2a936a858 | 35 | } |
| takeuchi | 0:11d2a936a858 | 36 | |
| takeuchi | 0:11d2a936a858 | 37 | void r_notch(float duty){ |
| takeuchi | 0:11d2a936a858 | 38 | r1_pwm.write(0); |
| takeuchi | 0:11d2a936a858 | 39 | r2_pwm.write(duty); |
| takeuchi | 0:11d2a936a858 | 40 | } |
| takeuchi | 0:11d2a936a858 | 41 | |
| takeuchi | 0:11d2a936a858 | 42 | int main() { |
| takeuchi | 0:11d2a936a858 | 43 | int i,count,ressha; |
| takeuchi | 0:11d2a936a858 | 44 | float pduty; |
| takeuchi | 0:11d2a936a858 | 45 | r1_pwm.pulsewidth(0.000001);//1us=0.000001 |
| takeuchi | 0:11d2a936a858 | 46 | r1_pwm.period(0.00001);//1ms=0.001s |
| takeuchi | 0:11d2a936a858 | 47 | r2_pwm.pulsewidth(0.000001);//1us=0.000001 |
| takeuchi | 0:11d2a936a858 | 48 | r2_pwm.period(0.00001);//1ms=0.001s |
| takeuchi | 0:11d2a936a858 | 49 | |
| takeuchi | 0:11d2a936a858 | 50 | count=0; |
| takeuchi | 0:11d2a936a858 | 51 | lcd.cls(); |
| takeuchi | 0:11d2a936a858 | 52 | lcd.locate(0,0); |
| takeuchi | 0:11d2a936a858 | 53 | lcd.printf("** mbed RMCS07 **"); |
| takeuchi | 0:11d2a936a858 | 54 | |
| takeuchi | 0:11d2a936a858 | 55 | while(1){ |
| takeuchi | 0:11d2a936a858 | 56 | pduty=vr1_adc.read(); |
| takeuchi | 0:11d2a936a858 | 57 | notch(pduty); |
| takeuchi | 0:11d2a936a858 | 58 | wait(1.0); |
| takeuchi | 0:11d2a936a858 | 59 | while(sens1==XOFF){ |
| takeuchi | 0:11d2a936a858 | 60 | pduty=vr1_adc.read(); |
| takeuchi | 0:11d2a936a858 | 61 | notch(pduty); |
| takeuchi | 0:11d2a936a858 | 62 | lcd.locate(0,1); |
| takeuchi | 0:11d2a936a858 | 63 | lcd.printf("d:%3.0f%%",pduty*100); |
| takeuchi | 0:11d2a936a858 | 64 | lcd.locate(0,2); |
| takeuchi | 0:11d2a936a858 | 65 | lcd.printf(" notch ON!"); |
| takeuchi | 0:11d2a936a858 | 66 | } |
| takeuchi | 0:11d2a936a858 | 67 | notch(0); |
| takeuchi | 0:11d2a936a858 | 68 | lcd.locate(0,1); |
| takeuchi | 0:11d2a936a858 | 69 | lcd.printf("d:%3.0f%%",0); |
| takeuchi | 0:11d2a936a858 | 70 | lcd.locate(0,2); |
| takeuchi | 0:11d2a936a858 | 71 | lcd.printf("Teishachu!!"); |
| takeuchi | 0:11d2a936a858 | 72 | wait(5.0); |
| takeuchi | 0:11d2a936a858 | 73 | pduty=vr2_adc.read(); |
| takeuchi | 0:11d2a936a858 | 74 | r_notch(pduty); |
| takeuchi | 0:11d2a936a858 | 75 | wait(1.0); |
| takeuchi | 0:11d2a936a858 | 76 | while(sens1==XOFF){ |
| takeuchi | 0:11d2a936a858 | 77 | pduty=vr2_adc.read(); |
| takeuchi | 0:11d2a936a858 | 78 | r_notch(pduty); |
| takeuchi | 0:11d2a936a858 | 79 | lcd.locate(0,1); |
| takeuchi | 0:11d2a936a858 | 80 | lcd.printf("d:%3.0f%%",pduty*100); |
| takeuchi | 0:11d2a936a858 | 81 | lcd.locate(0,2); |
| takeuchi | 0:11d2a936a858 | 82 | lcd.printf("r_notch ON!"); |
| takeuchi | 0:11d2a936a858 | 83 | |
| takeuchi | 0:11d2a936a858 | 84 | } |
| takeuchi | 0:11d2a936a858 | 85 | notch(0); |
| takeuchi | 0:11d2a936a858 | 86 | wait(3.0); |
| takeuchi | 0:11d2a936a858 | 87 | }//while |
| takeuchi | 0:11d2a936a858 | 88 | |
| takeuchi | 0:11d2a936a858 | 89 | }//main |