Jónar / Mbed OS Hopverkefni1

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:   X_NUCLEO_IKS01A1

main.cpp@2:ff2d1e351302, 2020-01-16 (annotated)

Committer:
ivardor
Date:
Thu Jan 16 14:41:19 2020 +0000
Revision:
2:ff2d1e351302
Parent:
1:ae01414cd891
Child:
3:8cbc430199af
tilfelli komin

Who changed what in which revision?

UserRevisionLine numberNew contents of line
ivardor 0:1ba5cfaab64e 1 /* Includes */
gesturandrei 1:ae01414cd891 2 #include <iostream>
gesturandrei 1:ae01414cd891 3 using namespace std;
ivardor 0:1ba5cfaab64e 4 #include "mbed.h"
ivardor 0:1ba5cfaab64e 5 #include "x_nucleo_iks01a1.h"
ivardor 0:1ba5cfaab64e 6
ivardor 0:1ba5cfaab64e 7 /* Instantiate the expansion board */
ivardor 0:1ba5cfaab64e 8 static X_NUCLEO_IKS01A1 *mems_expansion_board = X_NUCLEO_IKS01A1::Instance(D14, D15);
ivardor 0:1ba5cfaab64e 9
ivardor 0:1ba5cfaab64e 10 /* Retrieve the composing elements of the expansion board */
ivardor 0:1ba5cfaab64e 11 static GyroSensor *gyroscope = mems_expansion_board->GetGyroscope();
ivardor 0:1ba5cfaab64e 12 static MotionSensor *accelerometer = mems_expansion_board->GetAccelerometer();
ivardor 0:1ba5cfaab64e 13 static MagneticSensor *magnetometer = mems_expansion_board->magnetometer;
ivardor 0:1ba5cfaab64e 14 static HumiditySensor *humidity_sensor = mems_expansion_board->ht_sensor;
ivardor 0:1ba5cfaab64e 15 static PressureSensor *pressure_sensor = mems_expansion_board->pt_sensor;
ivardor 0:1ba5cfaab64e 16 static TempSensor *temp_sensor1 = mems_expansion_board->ht_sensor;
ivardor 0:1ba5cfaab64e 17 static TempSensor *temp_sensor2 = mems_expansion_board->pt_sensor;
ivardor 0:1ba5cfaab64e 18
ivardor 0:1ba5cfaab64e 19 /* Helper function for printing floats & doubles */
ivardor 0:1ba5cfaab64e 20 static char *printDouble(char* str, double v, int decimalDigits=2)
ivardor 0:1ba5cfaab64e 21 {
ivardor 0:1ba5cfaab64e 22 int i = 1;
ivardor 0:1ba5cfaab64e 23 int intPart, fractPart;
ivardor 0:1ba5cfaab64e 24 int len;
ivardor 0:1ba5cfaab64e 25 char *ptr;
ivardor 0:1ba5cfaab64e 26
ivardor 0:1ba5cfaab64e 27 /* prepare decimal digits multiplicator */
ivardor 0:1ba5cfaab64e 28 for (;decimalDigits!=0; i*=10, decimalDigits--);
ivardor 0:1ba5cfaab64e 29
ivardor 0:1ba5cfaab64e 30 /* calculate integer & fractinal parts */
ivardor 0:1ba5cfaab64e 31 intPart = (int)v;
ivardor 0:1ba5cfaab64e 32 fractPart = (int)((v-(double)(int)v)*i);
ivardor 0:1ba5cfaab64e 33
ivardor 0:1ba5cfaab64e 34 /* fill in integer part */
ivardor 0:1ba5cfaab64e 35 sprintf(str, "%i.", intPart);
ivardor 0:1ba5cfaab64e 36
ivardor 0:1ba5cfaab64e 37 /* prepare fill in of fractional part */
ivardor 0:1ba5cfaab64e 38 len = strlen(str);
ivardor 0:1ba5cfaab64e 39 ptr = &str[len];
ivardor 0:1ba5cfaab64e 40
ivardor 0:1ba5cfaab64e 41 /* fill in leading fractional zeros */
ivardor 0:1ba5cfaab64e 42 for (i/=10;i>1; i/=10, ptr++) {
ivardor 0:1ba5cfaab64e 43 if(fractPart >= i) break;
ivardor 0:1ba5cfaab64e 44 *ptr = '0';
ivardor 0:1ba5cfaab64e 45 }
ivardor 0:1ba5cfaab64e 46
ivardor 0:1ba5cfaab64e 47 /* fill in (rest of) fractional part */
ivardor 0:1ba5cfaab64e 48 sprintf(ptr, "%i", fractPart);
ivardor 0:1ba5cfaab64e 49
ivardor 0:1ba5cfaab64e 50 return str;
ivardor 0:1ba5cfaab64e 51 }
ivardor 0:1ba5cfaab64e 52
ivardor 0:1ba5cfaab64e 53
ivardor 2:ff2d1e351302 54
ivardor 2:ff2d1e351302 55
ivardor 2:ff2d1e351302 56
ivardor 2:ff2d1e351302 57
ivardor 2:ff2d1e351302 58 //lidur 3 og 5
ivardor 2:ff2d1e351302 59 /*
ivardor 2:ff2d1e351302 60 if (userInput == 1) {
ivardor 2:ff2d1e351302 61 printf("\r\n");
ivardor 2:ff2d1e351302 62
ivardor 2:ff2d1e351302 63 temp_sensor1->get_temperature(&value1);
ivardor 2:ff2d1e351302 64 humidity_sensor->get_humidity(&value2);
ivardor 2:ff2d1e351302 65 printf("HTS221: [temp] %7s°C, [hum] %s%%\r\n", printDouble(buffer1, value1), printDouble(buffer2, value2));
ivardor 2:ff2d1e351302 66
ivardor 2:ff2d1e351302 67 temp_sensor2->get_fahrenheit(&value1);
ivardor 2:ff2d1e351302 68 pressure_sensor->get_pressure(&value2);
ivardor 2:ff2d1e351302 69 printf("LPS25H: [temp] %7s°F, [press] %smbar\r\n", printDouble(buffer1, value1), printDouble(buffer2, value2));
ivardor 2:ff2d1e351302 70 } else if (userInput == 2) {
ivardor 2:ff2d1e351302 71 printf("---\r\n");
ivardor 2:ff2d1e351302 72
ivardor 2:ff2d1e351302 73 magnetometer->get_m_axes(axes);
ivardor 2:ff2d1e351302 74 printf("LIS3MDL [mag/mgauss]: %7ld, %7ld, %7ld\r\n", axes[0], axes[1], axes[2]);
ivardor 2:ff2d1e351302 75
ivardor 2:ff2d1e351302 76 accelerometer->get_x_axes(axes);
ivardor 2:ff2d1e351302 77 printf("LSM6DS0 [acc/mg]: %7ld, %7ld, %7ld\r\n", axes[0], axes[1], axes[2]);
ivardor 2:ff2d1e351302 78
ivardor 2:ff2d1e351302 79 gyroscope->get_g_axes(axes);
ivardor 2:ff2d1e351302 80 printf("LSM6DS0 [gyro/mdps]: %7ld, %7ld, %7ld\r\n", axes[0], axes[1], axes[2]);
ivardor 2:ff2d1e351302 81 }
ivardor 2:ff2d1e351302 82 */
ivardor 2:ff2d1e351302 83
ivardor 2:ff2d1e351302 84 void tilfelli1() {
ivardor 2:ff2d1e351302 85 printf("\r\n");
ivardor 2:ff2d1e351302 86 float value1, value2;
ivardor 2:ff2d1e351302 87 char buffer1[32], buffer2[32];
ivardor 2:ff2d1e351302 88 temp_sensor1->get_temperature(&value1);
ivardor 2:ff2d1e351302 89 humidity_sensor->get_humidity(&value2);
ivardor 2:ff2d1e351302 90 printf("Hitastig: %7s°C\n Rakastig: %s%%\r\n Loftþrýstingur: %smbar\r\n", printDouble(buffer1, value1), printDouble(buffer2, value2), printDouble(buffer2, value2));
ivardor 2:ff2d1e351302 91 printf("\n");
ivardor 2:ff2d1e351302 92 }
ivardor 2:ff2d1e351302 93
ivardor 2:ff2d1e351302 94
ivardor 2:ff2d1e351302 95 void tilfelli2() {
ivardor 2:ff2d1e351302 96 printf("\r\n");
ivardor 2:ff2d1e351302 97 float value1, value2;
ivardor 2:ff2d1e351302 98 char buffer1[32], buffer2[32];
ivardor 2:ff2d1e351302 99 temp_sensor1->get_temperature(&value1);
ivardor 2:ff2d1e351302 100 humidity_sensor->get_humidity(&value2);
ivardor 2:ff2d1e351302 101 printf("HTS221: [temp] %7s°C, [hum] %s%%\r\n", printDouble(buffer1, value1), printDouble(buffer2, value2));
ivardor 2:ff2d1e351302 102
ivardor 2:ff2d1e351302 103 temp_sensor2->get_fahrenheit(&value1);
ivardor 2:ff2d1e351302 104 pressure_sensor->get_pressure(&value2);
ivardor 2:ff2d1e351302 105 printf("LPS25H: [temp] %7s°F, [press] %smbar\r\n", printDouble(buffer1, value1), printDouble(buffer2, value2));
ivardor 2:ff2d1e351302 106 }
ivardor 2:ff2d1e351302 107
ivardor 2:ff2d1e351302 108
ivardor 0:1ba5cfaab64e 109 /* Simple main function */
ivardor 0:1ba5cfaab64e 110 int main() {
ivardor 0:1ba5cfaab64e 111 uint8_t id;
ivardor 0:1ba5cfaab64e 112 float value1, value2;
ivardor 0:1ba5cfaab64e 113 char buffer1[32], buffer2[32];
ivardor 0:1ba5cfaab64e 114 int32_t axes[3];
ivardor 0:1ba5cfaab64e 115
ivardor 0:1ba5cfaab64e 116 printf("\r\n--- Starting new run ---\r\n");
ivardor 0:1ba5cfaab64e 117
ivardor 0:1ba5cfaab64e 118 humidity_sensor->read_id(&id);
ivardor 0:1ba5cfaab64e 119 printf("HTS221 humidity & temperature = 0x%X\r\n", id);
ivardor 0:1ba5cfaab64e 120 pressure_sensor->read_id(&id);
ivardor 0:1ba5cfaab64e 121 printf("LPS25H pressure & temperature = 0x%X\r\n", id);
ivardor 0:1ba5cfaab64e 122 magnetometer->read_id(&id);
ivardor 0:1ba5cfaab64e 123 printf("LIS3MDL magnetometer = 0x%X\r\n", id);
ivardor 0:1ba5cfaab64e 124 gyroscope->read_id(&id);
ivardor 0:1ba5cfaab64e 125 printf("LSM6DS0 accelerometer & gyroscope = 0x%X\r\n", id);
ivardor 0:1ba5cfaab64e 126
ivardor 0:1ba5cfaab64e 127 wait(3);
ivardor 0:1ba5cfaab64e 128
ivardor 0:1ba5cfaab64e 129 while(1) {
gesturandrei 1:ae01414cd891 130 int userInput;
ivardor 2:ff2d1e351302 131 cout << " Veldu tilfelli 1-7: " << endl;
gesturandrei 1:ae01414cd891 132 cin >> userInput;
ivardor 2:ff2d1e351302 133 switch(userInput) {
ivardor 2:ff2d1e351302 134 case 1: tilfelli1();
ivardor 2:ff2d1e351302 135 case 2: tilfelli2();
ivardor 2:ff2d1e351302 136 default: break;
ivardor 2:ff2d1e351302 137 }
gesturandrei 1:ae01414cd891 138
ivardor 0:1ba5cfaab64e 139 }
ivardor 0:1ba5cfaab64e 140 }
ivardor 2:ff2d1e351302 141