Jesse Kaiser / Mbed 2 deprecated EMG_HIDScope_Gr6

Highpass en Notch filter voor EMG verwerking

Dependencies:   HIDScope mbed-dsp mbed

Fork of EMG_HIDScope by First Last

main.cpp@19:dbc1bca498e3, 2014-09-29 (annotated)

Committer:
vsluiter
Date:
Mon Sep 29 12:01:13 2014 +0000
Revision:
19:dbc1bca498e3
Parent:
18:fed07cc1f8f6
Child:
20:f7d281e3112b
Deleted superfluous code

Who changed what in which revision?

UserRevisionLine numberNew contents of line
vsluiter 0:32bb76391d89 1 #include "mbed.h"
vsluiter 6:80c13d99aa55 2 #include "MODSERIAL.h"
vsluiter 11:ce72ec658a95 3 #include "HIDScope.h"
vsluiter 0:32bb76391d89 4
vsluiter 18:fed07cc1f8f6 5 #include "arm_math.h"
vsluiter 18:fed07cc1f8f6 6
vsluiter 4:8b298dfada81 7 //Define objects
vsluiter 7:3396c3e33928 8 AnalogIn emg0(PTB1); //Analog input
vsluiter 8:8a17f65622b4 9 Ticker log_timer;
vsluiter 8:8a17f65622b4 10 MODSERIAL pc(USBTX,USBRX);
vsluiter 11:ce72ec658a95 11 HIDScope scope(2);
vsluiter 2:e314bb3b2d99 12
vsluiter 18:fed07cc1f8f6 13 arm_biquad_casd_df1_inst_f32 lowpass;
vsluiter 19:dbc1bca498e3 14 //constants for 5Hz lowpass
vsluiter 18:fed07cc1f8f6 15 float lowpass_const[] = {0.02008337 , 0.04016673 , 0.02008337 , 1.56101808 , -0.64135154};
vsluiter 18:fed07cc1f8f6 16
vsluiter 18:fed07cc1f8f6 17 arm_biquad_casd_df1_inst_f32 highpass;
vsluiter 19:dbc1bca498e3 18 //constants for 0.5Hz highpass
vsluiter 18:fed07cc1f8f6 19 float highpass_const[] = {0.97803048, -1.95606096, 0.97803048, 1.95557824 , -0.95654368};
vsluiter 15:d3a849ab3697 20
vsluiter 15:d3a849ab3697 21
vsluiter 4:8b298dfada81 22 /** Looper function
vsluiter 4:8b298dfada81 23 * functions used for Ticker and Timeout should be of type void <name>(void)
vsluiter 4:8b298dfada81 24 * i.e. no input arguments, no output arguments.
vsluiter 4:8b298dfada81 25 * if you want to change a variable that you use in other places (for example in main)
vsluiter 4:8b298dfada81 26 * you will have to make that variable global in order to be able to reach it both from
vsluiter 4:8b298dfada81 27 * the function called at interrupt time, and in the main function.
vsluiter 4:8b298dfada81 28 * To make a variable global, define it under the includes.
vsluiter 4:8b298dfada81 29 * variables that are changed in the interrupt routine (written to) should be made
vsluiter 4:8b298dfada81 30 * 'volatile' to let the compiler know that those values may change outside the current context.
vsluiter 8:8a17f65622b4 31 * i.e.: "volatile uint16_t emg_value;" instead of "uint16_t emg_value"
vsluiter 4:8b298dfada81 32 * in the example below, the variable is not re-used in the main function, and is thus declared
vsluiter 4:8b298dfada81 33 * local in the looper function only.
vsluiter 4:8b298dfada81 34 **/
vsluiter 2:e314bb3b2d99 35 void looper()
vsluiter 2:e314bb3b2d99 36 {
vsluiter 4:8b298dfada81 37 /*variable to store value in*/
vsluiter 8:8a17f65622b4 38 uint16_t emg_value;
vsluiter 15:d3a849ab3697 39 float filtered_emg;
vsluiter 18:fed07cc1f8f6 40 float emg_value_f32;
vsluiter 4:8b298dfada81 41 /*put raw emg value both in red and in emg_value*/
vsluiter 12:768048d7f742 42 emg_value = emg0.read_u16(); // read direct ADC result, converted to 16 bit integer (0..2^16 = 0..65536 = 0..3.3V)
vsluiter 18:fed07cc1f8f6 43 emg_value_f32 = emg0.read();
vsluiter 19:dbc1bca498e3 44
vsluiter 19:dbc1bca498e3 45 //process emg
vsluiter 18:fed07cc1f8f6 46 arm_biquad_cascade_df1_f32(&highpass, &emg_value_f32, &filtered_emg, 1 );
vsluiter 18:fed07cc1f8f6 47 filtered_emg = fabs(filtered_emg);
vsluiter 18:fed07cc1f8f6 48 arm_biquad_cascade_df1_f32(&lowpass, &filtered_emg, &filtered_emg, 1 );
vsluiter 19:dbc1bca498e3 49
vsluiter 19:dbc1bca498e3 50 /*send value to PC. */
vsluiter 19:dbc1bca498e3 51 scope.set(0,emg_value); //uint value
vsluiter 19:dbc1bca498e3 52 scope.set(1,filtered_emg); //processed float
vsluiter 11:ce72ec658a95 53 scope.send();
vsluiter 16:24e992616cf6 54
vsluiter 2:e314bb3b2d99 55 }
vsluiter 0:32bb76391d89 56
vsluiter 0:32bb76391d89 57 int main()
vsluiter 0:32bb76391d89 58 {
vsluiter 19:dbc1bca498e3 59
vsluiter 19:dbc1bca498e3 60 //set up filters. Use external array for constants
vsluiter 19:dbc1bca498e3 61 arm_biquad_cascade_df1_init_f32(&lowpass,1 , lowpass_const, lowpass.pState);
vsluiter 19:dbc1bca498e3 62 arm_biquad_cascade_df1_init_f32(&highpass,1 ,highpass_const,highpass.pState);
vsluiter 19:dbc1bca498e3 63
vsluiter 4:8b298dfada81 64 /**Here you attach the 'void looper(void)' function to the Ticker object
vsluiter 9:d33e7b175ad7 65 * The looper() function will be called every 0.01 seconds.
vsluiter 4:8b298dfada81 66 * Please mind that the parentheses after looper are omitted when using attach.
vsluiter 4:8b298dfada81 67 */
vsluiter 13:18d4cef1fdb4 68 log_timer.attach(looper, 0.005);
ArvidKeemink 1:db54d9412d18 69 while(1) //Loop
vsluiter 0:32bb76391d89 70 {
vsluiter 4:8b298dfada81 71 /*Empty!*/
vsluiter 4:8b298dfada81 72 /*Everything is handled by the interrupt routine now!*/
vsluiter 0:32bb76391d89 73 }
vsluiter 19:dbc1bca498e3 74 }