Seth Ruiter / Mbed 2 deprecated bouke

Important changes to repositories hosted on mbed.com

Mbed hosted mercurial repositories are deprecated and are due to be permanently deleted in July 2026.

To keep a copy of this software download the repository Zip archive or clone locally using Mercurial.

It is also possible to export all your personal repositories from the account settings page.

Dependencies:   MODSERIAL SDFileSystemSeth mbed

Fork of Opstellingbachelor_opdracht by Claudia Haarman

main.cpp@2:5c856ceaea2e, 2016-09-04 (annotated)

Committer:
c_haarm
Date:
Sun Sep 04 18:47:55 2016 +0000
Revision:
2:5c856ceaea2e
Parent:
1:8b45b3ad350a
Child:
3:b525b7a56553
declaration tc pins not correct --> digitalout (18) and digitalread (in readTC function) not working

Who changed what in which revision?

UserRevisionLine numberNew contents of line
c_haarm 0:f7cd934498e4 1 #include "mbed.h"
c_haarm 0:f7cd934498e4 2 #include "MODSERIAL.h"
c_haarm 0:f7cd934498e4 3 #include "SDFileSystem.h"
c_haarm 0:f7cd934498e4 4
c_haarm 0:f7cd934498e4 5
c_haarm 0:f7cd934498e4 6 ////////////////////Declarations////////////////////////////////////////////////
c_haarm 0:f7cd934498e4 7 ////////////////////////////////////////////////////////////////////////////////
c_haarm 0:f7cd934498e4 8 ////////////////////////////////////////////////////////////////////////////////
c_haarm 0:f7cd934498e4 9
c_haarm 1:8b45b3ad350a 10 // Thermocouple pin declarations
c_haarm 1:8b45b3ad350a 11 DigitalOut SCK_1(2);
c_haarm 1:8b45b3ad350a 12 DigitalOut CS_1(3);
c_haarm 1:8b45b3ad350a 13
c_haarm 1:8b45b3ad350a 14 int pins[12] = {4, 5, 6, 7, 8, 9, 10, 11, 12, 14, 15, 16};
c_haarm 1:8b45b3ad350a 15
c_haarm 1:8b45b3ad350a 16 for (int i = 0; i <= 11; i++)
c_haarm 1:8b45b3ad350a 17 {
c_haarm 1:8b45b3ad350a 18 DigitalOut(pins[i], INPUT);
c_haarm 1:8b45b3ad350a 19 }
c_haarm 1:8b45b3ad350a 20
c_haarm 1:8b45b3ad350a 21 double d;
c_haarm 1:8b45b3ad350a 22 int b[12] = { };
c_haarm 1:8b45b3ad350a 23
c_haarm 1:8b45b3ad350a 24 // Torque sensor
c_haarm 0:f7cd934498e4 25 AnalogIn fcs(PTB2); // force sensor output connected to analog 0
c_haarm 0:f7cd934498e4 26
c_haarm 1:8b45b3ad350a 27
c_haarm 1:8b45b3ad350a 28 // LED
c_haarm 0:f7cd934498e4 29 DigitalOut r_led(LED_RED);
c_haarm 0:f7cd934498e4 30 DigitalOut g_led(LED_GREEN);
c_haarm 0:f7cd934498e4 31 DigitalOut b_led(LED_BLUE);
c_haarm 0:f7cd934498e4 32
c_haarm 1:8b45b3ad350a 33 // Serial connection and SD
c_haarm 0:f7cd934498e4 34 MODSERIAL pc(USBTX,USBRX, 1024, 512);
c_haarm 0:f7cd934498e4 35 SDFileSystem sd(PTE3, PTE1, PTE2, PTE4, "sd"); // MOSI, MISO, SCK, CS
c_haarm 0:f7cd934498e4 36 FILE *fp;
c_haarm 0:f7cd934498e4 37
c_haarm 1:8b45b3ad350a 38 // Other declarations
c_haarm 0:f7cd934498e4 39 Ticker tick;
c_haarm 0:f7cd934498e4 40
c_haarm 0:f7cd934498e4 41 const int baudrate = 115200; // baud rate
c_haarm 0:f7cd934498e4 42 const float Ts = 0.005; // sample time (sec)
c_haarm 0:f7cd934498e4 43
c_haarm 0:f7cd934498e4 44 const int led_on = 0;
c_haarm 0:f7cd934498e4 45 const int led_off = 1;
c_haarm 0:f7cd934498e4 46
c_haarm 0:f7cd934498e4 47 volatile bool fn1_go = 0; // go-flag starts in disabled state
c_haarm 0:f7cd934498e4 48 volatile bool start = 0;
c_haarm 0:f7cd934498e4 49
c_haarm 0:f7cd934498e4 50 float fcs_read;
c_haarm 0:f7cd934498e4 51
c_haarm 0:f7cd934498e4 52 int trial_numb = 0;
c_haarm 0:f7cd934498e4 53 int cal_numb = 1;
c_haarm 0:f7cd934498e4 54
c_haarm 1:8b45b3ad350a 55 char filename_torque[64];
c_haarm 1:8b45b3ad350a 56 char filename_temp[64];
c_haarm 1:8b45b3ad350a 57 char filename_cal[64];
c_haarm 1:8b45b3ad350a 58
c_haarm 0:f7cd934498e4 59
c_haarm 0:f7cd934498e4 60
c_haarm 0:f7cd934498e4 61
c_haarm 0:f7cd934498e4 62 ////////////////////Functions///////////////////////////////////////////////////
c_haarm 0:f7cd934498e4 63 ////////////////////////////////////////////////////////////////////////////////
c_haarm 0:f7cd934498e4 64 ////////////////////////////////////////////////////////////////////////////////
c_haarm 0:f7cd934498e4 65
c_haarm 0:f7cd934498e4 66 void led_control(bool r, bool g, bool b) // control rgb LEDs
c_haarm 0:f7cd934498e4 67 {
c_haarm 0:f7cd934498e4 68 r_led.write(r);
c_haarm 0:f7cd934498e4 69 g_led.write(g);
c_haarm 0:f7cd934498e4 70 b_led.write(b);
c_haarm 0:f7cd934498e4 71 return;
c_haarm 0:f7cd934498e4 72 }
c_haarm 0:f7cd934498e4 73
c_haarm 0:f7cd934498e4 74 void fn1_activate() // function called by ticker every Ts seconds
c_haarm 0:f7cd934498e4 75 {
c_haarm 0:f7cd934498e4 76 fn1_go = 1; // go-flag active
c_haarm 0:f7cd934498e4 77 }
c_haarm 0:f7cd934498e4 78
c_haarm 1:8b45b3ad350a 79 void readTC()
c_haarm 1:8b45b3ad350a 80 {
c_haarm 1:8b45b3ad350a 81 CS_1 = 0;
c_haarm 1:8b45b3ad350a 82 wait_ms(70);
c_haarm 1:8b45b3ad350a 83
c_haarm 1:8b45b3ad350a 84 for (int i = 15; i >= 0; i--) {
c_haarm 1:8b45b3ad350a 85 SCK_1 = 0;
c_haarm 1:8b45b3ad350a 86 SCK_1 = 1;
c_haarm 1:8b45b3ad350a 87 for (int j = 0; j <= 11; j++) {
c_haarm 1:8b45b3ad350a 88 if (digitalRead(pins[j])) {
c_haarm 1:8b45b3ad350a 89 b[j] |= (1 << i);
c_haarm 1:8b45b3ad350a 90 }
c_haarm 1:8b45b3ad350a 91 }
c_haarm 1:8b45b3ad350a 92 }
c_haarm 1:8b45b3ad350a 93
c_haarm 1:8b45b3ad350a 94 CS_1 = 1;
c_haarm 1:8b45b3ad350a 95
c_haarm 1:8b45b3ad350a 96 for (int j = 0; j <= 11; j++) {
c_haarm 1:8b45b3ad350a 97 if (b[j] & 0x1) {
c_haarm 1:8b45b3ad350a 98 b[j] = 20000;
c_haarm 1:8b45b3ad350a 99 } else {
c_haarm 1:8b45b3ad350a 100 b[j] &= 0xfffc;
c_haarm 1:8b45b3ad350a 101 d = b[j] / 16.0 * 100.0;
c_haarm 1:8b45b3ad350a 102 b[j] = d;
c_haarm 1:8b45b3ad350a 103 }
c_haarm 1:8b45b3ad350a 104 fprintf(fp, "%.3f\t", b[j]);
c_haarm 1:8b45b3ad350a 105 }
c_haarm 1:8b45b3ad350a 106 fprintf(fp, "\n\r");
c_haarm 1:8b45b3ad350a 107
c_haarm 1:8b45b3ad350a 108
c_haarm 1:8b45b3ad350a 109 }
c_haarm 0:f7cd934498e4 110
c_haarm 0:f7cd934498e4 111 ////////////////////Main////////////////////////////////////////////////////////
c_haarm 0:f7cd934498e4 112 ////////////////////////////////////////////////////////////////////////////////
c_haarm 0:f7cd934498e4 113 ////////////////////////////////////////////////////////////////////////////////
c_haarm 0:f7cd934498e4 114
c_haarm 0:f7cd934498e4 115 int main()
c_haarm 0:f7cd934498e4 116 {
c_haarm 0:f7cd934498e4 117 pc.baud(baudrate);
c_haarm 0:f7cd934498e4 118 tick.attach(&fn1_activate,Ts);
c_haarm 0:f7cd934498e4 119 led_control(led_off,led_off,led_off); // start with LEDs off
c_haarm 0:f7cd934498e4 120
c_haarm 0:f7cd934498e4 121 while (1) {
c_haarm 0:f7cd934498e4 122 if(fn1_go) { // statements to execute when go-flag is active
c_haarm 0:f7cd934498e4 123 fn1_go = 0;
c_haarm 0:f7cd934498e4 124
c_haarm 0:f7cd934498e4 125 }
c_haarm 0:f7cd934498e4 126
c_haarm 0:f7cd934498e4 127 if(pc.readable()) { // if character available
c_haarm 0:f7cd934498e4 128 switch(pc.getc()) { // read a character from keyboard
c_haarm 0:f7cd934498e4 129 case 'c':
c_haarm 1:8b45b3ad350a 130 led_control(led_on,led_on,led_off); //orange LED during calibration
c_haarm 1:8b45b3ad350a 131 sprintf(filename_cal, "/sd/cal_torque_%d.txt", cal_numb); //construct new textfile
c_haarm 1:8b45b3ad350a 132 fp = fopen(filename_cal, "w");
c_haarm 0:f7cd934498e4 133 if(fp == NULL) {
c_haarm 0:f7cd934498e4 134 error("Could not open file for write\n");
c_haarm 0:f7cd934498e4 135 } else {
c_haarm 0:f7cd934498e4 136 while(1) {
c_haarm 0:f7cd934498e4 137 for (int i = 0; i<50; i++) { //get 50 samples from torque sensor
c_haarm 0:f7cd934498e4 138 fcs_read = fcs.read();
c_haarm 0:f7cd934498e4 139 fprintf(fp, "%.3f\t \n\r", fcs_read); //output values to the screen
c_haarm 0:f7cd934498e4 140 }
c_haarm 0:f7cd934498e4 141 break;
c_haarm 0:f7cd934498e4 142 }
c_haarm 0:f7cd934498e4 143 }
c_haarm 0:f7cd934498e4 144 fclose(fp); //close file
c_haarm 0:f7cd934498e4 145 cal_numb++; //increment calibration number
c_haarm 1:8b45b3ad350a 146 pc.printf("File saved as %s\n\r", filename_cal); //print name of calibration file to screen
c_haarm 0:f7cd934498e4 147 pc.printf("Press 'c' to record new calibration or 't' to start new trial\n\r"); // print message to screen
c_haarm 0:f7cd934498e4 148 break;
c_haarm 0:f7cd934498e4 149 case 't':
c_haarm 0:f7cd934498e4 150 trial_numb++;
c_haarm 0:f7cd934498e4 151 pc.printf("Trial number: %d\n\r", trial_numb);
c_haarm 0:f7cd934498e4 152 pc.printf("Press 's' to start measurement\n\r");
c_haarm 0:f7cd934498e4 153 break;
c_haarm 0:f7cd934498e4 154 case 's':
c_haarm 0:f7cd934498e4 155 start = !start;
c_haarm 0:f7cd934498e4 156 if (start) {
c_haarm 2:5c856ceaea2e 157 led_control(led_off,led_on,led_off); //green LED during measurement
c_haarm 0:f7cd934498e4 158 sprintf(filename_torque, "/sd/trial%d.txt", trial_numb); //construct new textfile to store data from torque sensor
c_haarm 0:f7cd934498e4 159 fp = fopen(filename_torque, "w");
c_haarm 0:f7cd934498e4 160 if(fp == NULL) {
c_haarm 0:f7cd934498e4 161 error("Could not open file for write\n\r");
c_haarm 0:f7cd934498e4 162 } else {
c_haarm 0:f7cd934498e4 163 pc.printf("Measurement started... \n\r");
c_haarm 0:f7cd934498e4 164 pc.printf("Press 's' to stop measurement\n\r");
c_haarm 2:5c856ceaea2e 165 while(1) {
c_haarm 2:5c856ceaea2e 166 fcs_read = fcs.read(); // capture torque sensor data
c_haarm 2:5c856ceaea2e 167 fprintf(fp, "%.3f\t", fcs_read); // output data to file
c_haarm 2:5c856ceaea2e 168 readTC(b); // call function to read thermocouple data
c_haarm 0:f7cd934498e4 169 }
c_haarm 0:f7cd934498e4 170 break;
c_haarm 0:f7cd934498e4 171 }
c_haarm 0:f7cd934498e4 172
c_haarm 0:f7cd934498e4 173 break;
c_haarm 0:f7cd934498e4 174 } else {
c_haarm 0:f7cd934498e4 175 led_control(led_on,led_off,led_off); // RED LED when ready to stopped measuring
c_haarm 0:f7cd934498e4 176 fclose(fp);
c_haarm 0:f7cd934498e4 177 pc.printf("File saved as %s\n\r", filename_torque); // print filename to screen
c_haarm 1:8b45b3ad350a 178 pc.printf("Press 'c' to perform new calibration or 't' to start new trial\n\r"); // print message to screen
c_haarm 0:f7cd934498e4 179
c_haarm 0:f7cd934498e4 180 }
c_haarm 0:f7cd934498e4 181 break;
c_haarm 0:f7cd934498e4 182 }
c_haarm 0:f7cd934498e4 183 }
c_haarm 0:f7cd934498e4 184 }
c_haarm 0:f7cd934498e4 185 }