キャタピラ用
Dependencies: 2342L012CR HCSR04 L6470 test_test MMA8451Q TSI mbed
main.cpp
- Committer:
- e00nagog
- Date:
- 2013-11-02
- Revision:
- 0:049054ab53f0
File content as of revision 0:049054ab53f0:
//DC_Moter //2013.11.02 //Ver 0.0.001 //m.saito #include "mbed.h" #include "TSISensor.h" int main() { PwmOut M1IN1(PTD4); PwmOut M1IN2(PTA12); PwmOut M2IN1(PTA4); PwmOut M2IN2(PTA5); TSISensor tsi; while(1){ M1IN1 = 0; M1IN2 = 0; M2IN1 = 1.0; M2IN2 = 0; } } /* //step_Moter //2013.10.19 //Ver 0.0.001 //m.saito #include "mbed.h" #include "L6470.h" //Serial pc(USBTX, USBRX); L6470 step1(PTD2, PTD3, PTD1,PTC0); // mosi, miso, sclk //L6470 step2(p5, p6, p7,p11); // mosi, miso, sclk int main() { step1.Resets(); //step2.Resets(); step1.Run(1,0x800); //step2.Run(1,0x800); wait_us(1); } */ /* //DC_Moter(G-sensor,touchpad) //Ultrasonic //2013.10.12 //Ver 0.0.001 //m.saito #include "mbed.h" #include "TSISensor.h" #include "MMA8451Q.h" #include "LCD.h" #include "HCSR04.h" #define MMA8451_I2C_ADDRESS (0x1d<<1) int main(void) { //class-object HCSR04 sensor(PTC10, PTC11); //Ultrasonic LCD lcd(PTE0,PTE1); //LCD MMA8451Q acc(PTE25, PTE24, MMA8451_I2C_ADDRESS); //G-sensor PwmOut mtr(PTA12); //cw-only TSISensor tsi; //touchpad-sensor //variable float g = 0; //G-sensor char g_str[20]; float tp=0; //touchpad char tp_str[20]; long length; //Ultrasonic-length char lg_str[20]; mtr = 1; //Duty Ratio while (1) { g = acc.getAccX()*90; //kakudo hyouji tp = tsi.readPercentage(); mtr = (tsi.readPercentage()==0)?(1-abs(acc.getAccX())):tp; wait(0.1); length = sensor.distance(1); //cm-hyouji lcd.cls(); lcd.locate(0,0); sprintf (g_str,"%+5.1f",g); lcd.printf("%s%s",g_str,"do"); lcd.locate(0,1); sprintf (tp_str,"%+5.3f",tp); lcd.printf("%s%s",tp_str,"tp"); wait (0.5); lcd.cls(); sprintf (lg_str,"%5d",length); lcd.printf("%s%s",lg_str,"cm"); wait (0.5); } } */