Vitec Group
As used for motor testing May / June 2016
Dependencies: iC_MU mbed-rtos mbed
Fork of
SweptSine
by 
Vitec Group
Pan_Feedback.cpp@3:463edcfc09c5, 2016-06-08 (annotated)
- Committer:
- acodd
- Date:
- Wed Jun 08 13:56:25 2016 +0000
- Revision:
- 3:463edcfc09c5
As used for scoping motors May / June 2016
Who changed what in which revision?
| User | Revision | Line number | New contents of line |
|---|---|---|---|
| acodd | 3:463edcfc09c5 | 1 | #include "mbed.h" |
| acodd | 3:463edcfc09c5 | 2 | #include "rtos.h" |
| acodd | 3:463edcfc09c5 | 3 | |
| acodd | 3:463edcfc09c5 | 4 | float Pan_count = 1000; |
| acodd | 3:463edcfc09c5 | 5 | |
| acodd | 3:463edcfc09c5 | 6 | InterruptIn pan_pulser(p30); // Pulse counter for Pan axis in this case 10 counts per rev. NOTE!! this has to be 3.3V, |
| acodd | 3:463edcfc09c5 | 7 | |
| acodd | 3:463edcfc09c5 | 8 | void func_fall(void) |
| acodd | 3:463edcfc09c5 | 9 | { |
| acodd | 3:463edcfc09c5 | 10 | // pc.printf("fall.\n\r"); |
| acodd | 3:463edcfc09c5 | 11 | //Pan_count = Pan_count -1000; |
| acodd | 3:463edcfc09c5 | 12 | if (Pan_count > 0) { |
| acodd | 3:463edcfc09c5 | 13 | Pan_count = 0; |
| acodd | 3:463edcfc09c5 | 14 | } else { |
| acodd | 3:463edcfc09c5 | 15 | Pan_count = 1000; |
| acodd | 3:463edcfc09c5 | 16 | } |
| acodd | 3:463edcfc09c5 | 17 | } |
| acodd | 3:463edcfc09c5 | 18 | void func_rise(void) |
| acodd | 3:463edcfc09c5 | 19 | { |
| acodd | 3:463edcfc09c5 | 20 | //pc.printf("rise.\n\r"); |
| acodd | 3:463edcfc09c5 | 21 | //Pan_count = Pan_count +1000; |
| acodd | 3:463edcfc09c5 | 22 | if (Pan_count > 0) { |
| acodd | 3:463edcfc09c5 | 23 | Pan_count = 0; |
| acodd | 3:463edcfc09c5 | 24 | } else { |
| acodd | 3:463edcfc09c5 | 25 | Pan_count = 1000; |
| acodd | 3:463edcfc09c5 | 26 | } |
| acodd | 3:463edcfc09c5 | 27 | } |
| acodd | 3:463edcfc09c5 | 28 | |
| acodd | 3:463edcfc09c5 | 29 | void Pan_Counter(void const *args) |
| acodd | 3:463edcfc09c5 | 30 | { |
| acodd | 3:463edcfc09c5 | 31 | pan_pulser.fall(&func_fall); |
| acodd | 3:463edcfc09c5 | 32 | pan_pulser.rise(&func_rise); |
| acodd | 3:463edcfc09c5 | 33 | } |
| acodd | 3:463edcfc09c5 | 34 | |
| acodd | 3:463edcfc09c5 | 35 | |
| acodd | 3:463edcfc09c5 | 36 |