Yoonseok Pyo
ORTP-L Sensor Test
Dependencies: Motordriver RIT mbed
Revision 0:ced7b365b52d, committed 2013-03-28
- Comitter:
- passionvirus
- Date:
- Thu Mar 28 12:20:24 2013 +0000
- Commit message:
- init;
Changed in this revision
diff -r 000000000000 -r ced7b365b52d Motordriver.lib --- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/Motordriver.lib Thu Mar 28 12:20:24 2013 +0000 @@ -0,0 +1,1 @@ +http://mbed.org/users/littlexc/code/Motordriver/#3110b9209d3c
diff -r 000000000000 -r ced7b365b52d RIT.lib --- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/RIT.lib Thu Mar 28 12:20:24 2013 +0000 @@ -0,0 +1,1 @@ +http://mbed.org/users/wvd_vegt/code/RIT/#64198265f56f
diff -r 000000000000 -r ced7b365b52d main.cpp
--- /dev/null Thu Jan 01 00:00:00 1970 +0000
+++ b/main.cpp Thu Mar 28 12:20:24 2013 +0000
@@ -0,0 +1,76 @@
+#include "mbed.h"
+#include "motordriver.h"
+#include "RIT.h"
+
+AnalogIn L_IR1(p15); // Analog In Pin
+AnalogIn L_IR2(p16); // Analog In Pin
+AnalogIn L_IR3(p17); // Analog In Pin
+AnalogIn R_IR3(p18); // Analog In Pin
+AnalogIn R_IR2(p19); // Analog In Pin
+AnalogIn R_IR1(p20); // Analog In Pin
+
+DigitalOut LLED(p7); // Digital Out Pin
+DigitalOut RLED(p8);
+
+DigitalOut L_IRLED1(p9); // Digital Out Pin
+DigitalOut L_IRLED2(p10); // Digital Out Pin
+DigitalOut L_IRLED3(p11); // Digital Out Pin
+DigitalOut R_IRLED3(p12); // Digital Out Pin
+DigitalOut R_IRLED2(p13); // Digital Out Pin
+DigitalOut R_IRLED1(p14); // Digital Out Pin
+
+Serial serial(USBTX,USBRX); // Tx, Rx Pin
+
+volatile uint32_t rithits = 0; //timer1 stops when timer1hits==imer1loop
+
+Timer rit_timing;
+
+void RIT_IRQHandler(void)
+{
+ //Flash Led.
+ L_IRLED1=!L_IRLED1;
+ L_IRLED2=!L_IRLED2;
+ L_IRLED3=!L_IRLED3;
+ R_IRLED3=!R_IRLED3;
+ R_IRLED2=!R_IRLED2;
+ R_IRLED1=!R_IRLED1;
+
+ //Count Hits.
+ rithits++;
+}
+
+RIT rit(1); //10ms
+
+int main()
+{
+ LLED=1;
+ RLED=1; // LED Init
+ int data[6];
+ serial.baud(115200);
+ rit.setup_us(10);
+
+ rit.append(RIT_IRQHandler);
+
+ rit_timing.start();
+ rit.enable();
+
+ while(1)
+ {
+ data[0] = L_IR1 * 100; // ain (0.0 ~ 1.0)
+ data[1] = L_IR2 * 100; // ain (0.0 ~ 1.0)
+ data[2] = L_IR3 * 100; // ain (0.0 ~ 1.0)
+ data[3] = R_IR3 * 100; // ain (0.0 ~ 1.0)
+ data[4] = R_IR2 * 100; // ain (0.0 ~ 1.0)
+ data[5] = R_IR1 * 100; // ain (0.0 ~ 1.0)
+
+ serial.printf("| %03d | %03d | %03d | %03d | %03d | %03d |\n", data[0], data[1], data[2], data[3], data[4], data[5]); // mbed -> PC, data(0~100)
+ }
+
+ rit.unappend();
+ rit.append(RIT_IRQHandler);
+ rit.disable();
+ rit_timing.stop();
+
+ rit_timing.start();
+ rit.enable();
+}
diff -r 000000000000 -r ced7b365b52d mbed.bld --- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/mbed.bld Thu Mar 28 12:20:24 2013 +0000 @@ -0,0 +1,1 @@ +http://mbed.org/users/mbed_official/code/mbed/builds/5e5da4a5990b \ No newline at end of file