Jónar / Mbed OS Hopverkefni1

Dependencies:   X_NUCLEO_IKS01A1

Committer:
ivardor
Date:
Thu Jan 16 13:51:17 2020 +0000
Revision:
0:1ba5cfaab64e
Child:
1:ae01414cd891
hola

Who changed what in which revision?

UserRevisionLine numberNew contents of line
ivardor 0:1ba5cfaab64e 1 /* Includes */
ivardor 0:1ba5cfaab64e 2 #include "mbed.h"
ivardor 0:1ba5cfaab64e 3 #include "x_nucleo_iks01a1.h"
ivardor 0:1ba5cfaab64e 4 #include <iostream>
ivardor 0:1ba5cfaab64e 5 using namespace std;
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 0:1ba5cfaab64e 54 /* Simple main function */
ivardor 0:1ba5cfaab64e 55 int main() {
ivardor 0:1ba5cfaab64e 56 uint8_t id;
ivardor 0:1ba5cfaab64e 57 float value1, value2;
ivardor 0:1ba5cfaab64e 58 char buffer1[32], buffer2[32];
ivardor 0:1ba5cfaab64e 59 int32_t axes[3];
ivardor 0:1ba5cfaab64e 60
ivardor 0:1ba5cfaab64e 61 printf("\r\n--- Starting new run ---\r\n");
ivardor 0:1ba5cfaab64e 62
ivardor 0:1ba5cfaab64e 63 humidity_sensor->read_id(&id);
ivardor 0:1ba5cfaab64e 64 printf("HTS221 humidity & temperature = 0x%X\r\n", id);
ivardor 0:1ba5cfaab64e 65 pressure_sensor->read_id(&id);
ivardor 0:1ba5cfaab64e 66 printf("LPS25H pressure & temperature = 0x%X\r\n", id);
ivardor 0:1ba5cfaab64e 67 magnetometer->read_id(&id);
ivardor 0:1ba5cfaab64e 68 printf("LIS3MDL magnetometer = 0x%X\r\n", id);
ivardor 0:1ba5cfaab64e 69 gyroscope->read_id(&id);
ivardor 0:1ba5cfaab64e 70 printf("LSM6DS0 accelerometer & gyroscope = 0x%X\r\n", id);
ivardor 0:1ba5cfaab64e 71
ivardor 0:1ba5cfaab64e 72 wait(3);
ivardor 0:1ba5cfaab64e 73
ivardor 0:1ba5cfaab64e 74 while(1) {
ivardor 0:1ba5cfaab64e 75 printf("\r\n");
ivardor 0:1ba5cfaab64e 76
ivardor 0:1ba5cfaab64e 77 temp_sensor1->get_temperature(&value1);
ivardor 0:1ba5cfaab64e 78 humidity_sensor->get_humidity(&value2);
ivardor 0:1ba5cfaab64e 79 printf("HTS221: [temp] %7s°C, [hum] %s%%\r\n", printDouble(buffer1, value1), printDouble(buffer2, value2));
ivardor 0:1ba5cfaab64e 80
ivardor 0:1ba5cfaab64e 81 temp_sensor2->get_fahrenheit(&value1);
ivardor 0:1ba5cfaab64e 82 pressure_sensor->get_pressure(&value2);
ivardor 0:1ba5cfaab64e 83 printf("LPS25H: [temp] %7s°F, [press] %smbar\r\n", printDouble(buffer1, value1), printDouble(buffer2, value2));
ivardor 0:1ba5cfaab64e 84
ivardor 0:1ba5cfaab64e 85 printf("---\r\n");
ivardor 0:1ba5cfaab64e 86
ivardor 0:1ba5cfaab64e 87 magnetometer->get_m_axes(axes);
ivardor 0:1ba5cfaab64e 88 printf("LIS3MDL [mag/mgauss]: %7ld, %7ld, %7ld\r\n", axes[0], axes[1], axes[2]);
ivardor 0:1ba5cfaab64e 89
ivardor 0:1ba5cfaab64e 90 accelerometer->get_x_axes(axes);
ivardor 0:1ba5cfaab64e 91 printf("LSM6DS0 [acc/mg]: %7ld, %7ld, %7ld\r\n", axes[0], axes[1], axes[2]);
ivardor 0:1ba5cfaab64e 92
ivardor 0:1ba5cfaab64e 93 gyroscope->get_g_axes(axes);
ivardor 0:1ba5cfaab64e 94 printf("LSM6DS0 [gyro/mdps]: %7ld, %7ld, %7ld\r\n", axes[0], axes[1], axes[2]);
ivardor 0:1ba5cfaab64e 95
ivardor 0:1ba5cfaab64e 96 wait(5);
ivardor 0:1ba5cfaab64e 97 }
ivardor 0:1ba5cfaab64e 98 }