Dominique Clevers / Mbed 2 deprecated TEST

aanpassing met notch

Dependencies:   Encoder HIDScope MODSERIAL mbed

Fork of TEST by Daan

main.cpp@0:7ae2a1b6379e, 2014-10-01 (annotated)

Committer:
Daanmk
Date:
Wed Oct 01 13:05:27 2014 +0000
Revision:
0:7ae2a1b6379e
Child:
1:c66edcd91108
Test met hidscope;

Who changed what in which revision?

UserRevisionLine numberNew contents of line
Daanmk 0:7ae2a1b6379e 1 /***************************************/
Daanmk 0:7ae2a1b6379e 2 /* */
Daanmk 0:7ae2a1b6379e 3 /* BRONCODE GROEP 5, MODULE 9, 2014 */
Daanmk 0:7ae2a1b6379e 4 /* *****-THE SLAP-****** */
Daanmk 0:7ae2a1b6379e 5 /* */
Daanmk 0:7ae2a1b6379e 6 /* -Dominique Clevers */
Daanmk 0:7ae2a1b6379e 7 /* -Rianne van Dommelen */
Daanmk 0:7ae2a1b6379e 8 /* -Daan de Muinck Keizer */
Daanmk 0:7ae2a1b6379e 9 /* -David den Houting */
Daanmk 0:7ae2a1b6379e 10 /* -Marjolein Thijssen */
Daanmk 0:7ae2a1b6379e 11 /***************************************/
Daanmk 0:7ae2a1b6379e 12 #include "mbed.h"
Daanmk 0:7ae2a1b6379e 13 #include "MODSERIAL.h"
Daanmk 0:7ae2a1b6379e 14 #include "encoder.h"
Daanmk 0:7ae2a1b6379e 15 #include "HIDScope.h"
Daanmk 0:7ae2a1b6379e 16 //Define objects
Daanmk 0:7ae2a1b6379e 17 Ticker log_timer;
Daanmk 0:7ae2a1b6379e 18 HIDScope scope(4);
Daanmk 0:7ae2a1b6379e 19 PwmOut red(LED_RED);
Daanmk 0:7ae2a1b6379e 20 PwmOut green(LED_GREEN);
Daanmk 0:7ae2a1b6379e 21 PwmOut blue(LED_BLUE);
Daanmk 0:7ae2a1b6379e 22 AnalogIn emgbc(PTB0); //Onderste bordje biceps meting
Daanmk 0:7ae2a1b6379e 23 AnalogIn emgtr(PTB1); //Tweede bordje triceps meting
Daanmk 0:7ae2a1b6379e 24 //DigitalOut motordirA(PTD3);
Daanmk 0:7ae2a1b6379e 25 //DigitalOut motordirB(PTD1);
Daanmk 0:7ae2a1b6379e 26 //Encoder motor1(PTD0,PTC9);
Daanmk 0:7ae2a1b6379e 27 //Encoder motor2(PTD5,PTC8);
Daanmk 0:7ae2a1b6379e 28
Daanmk 0:7ae2a1b6379e 29 MODSERIAL pc(USBTX,USBRX);
Daanmk 0:7ae2a1b6379e 30 //float emg1,emg2,emg1_high,emg2_high,emg1filtered,emg2filtered;
Daanmk 0:7ae2a1b6379e 31
Daanmk 0:7ae2a1b6379e 32 //void meten()
Daanmk 0:7ae2a1b6379e 33 //{
Daanmk 0:7ae2a1b6379e 34 // //int i=0;
Daanmk 0:7ae2a1b6379e 35 // //emg signaal verwerken en offset verwijderen:
Daanmk 0:7ae2a1b6379e 36 // emg1 = (emgbc.read()-0.5)*2; /* BICEPS */
Daanmk 0:7ae2a1b6379e 37 // emg2 = (emgtr.read()-0.5)*2; /* TRICEPS */
Daanmk 0:7ae2a1b6379e 38 //}
Daanmk 0:7ae2a1b6379e 39 void looper()
Daanmk 0:7ae2a1b6379e 40 {
Daanmk 0:7ae2a1b6379e 41 /*variable to store value in*/
Daanmk 0:7ae2a1b6379e 42 uint16_t emg_value0;
Daanmk 0:7ae2a1b6379e 43 uint16_t emg_value1;
Daanmk 0:7ae2a1b6379e 44 /*put raw emg value both in red and in emg_value*/
Daanmk 0:7ae2a1b6379e 45 red.write(emgbc.read()); // read float value (0..1 = 0..3.3V)
Daanmk 0:7ae2a1b6379e 46 blue.write(emgtr.read());
Daanmk 0:7ae2a1b6379e 47 emg_value0 = emgbc.read_u16();
Daanmk 0:7ae2a1b6379e 48 emg_value1 = emgtr.read_u16(); // read direct ADC result (0..4096 = 0..3.3V)
Daanmk 0:7ae2a1b6379e 49 /*send value to PC. Line below is used to prevent buffer overrun */
Daanmk 0:7ae2a1b6379e 50 scope.set(0,emg_value0);
Daanmk 0:7ae2a1b6379e 51 scope.set(1,red.read());
Daanmk 0:7ae2a1b6379e 52 scope.set(2,emg_value1);
Daanmk 0:7ae2a1b6379e 53 scope.set(3,blue.read());
Daanmk 0:7ae2a1b6379e 54 scope.set(4,emg_value1);
Daanmk 0:7ae2a1b6379e 55 scope.set(5,blue.read());
Daanmk 0:7ae2a1b6379e 56 scope.send();
Daanmk 0:7ae2a1b6379e 57 }
Daanmk 0:7ae2a1b6379e 58
Daanmk 0:7ae2a1b6379e 59 int main()
Daanmk 0:7ae2a1b6379e 60 {
Daanmk 0:7ae2a1b6379e 61 /*setup baudrate. Choose the same in your program on PC side*/
Daanmk 0:7ae2a1b6379e 62 pc.baud(115200);
Daanmk 0:7ae2a1b6379e 63 /*set the period for the PWM to the red LED*/
Daanmk 0:7ae2a1b6379e 64 red.period_ms(2);
Daanmk 0:7ae2a1b6379e 65 log_timer.attach(looper, 0.005);
Daanmk 0:7ae2a1b6379e 66 while(1) //Loop
Daanmk 0:7ae2a1b6379e 67 {
Daanmk 0:7ae2a1b6379e 68 }
Daanmk 0:7ae2a1b6379e 69 }