STM32 ile DENEYSEL ANEMOMETRE

// ----- libraries #include #include #include // ------ Create a new instance for each sensor VL6180X North; // North-facing sensor VL6180X East; // East-facing sensor LiquidCrystal_I2C ekran(0x27,16,2); // ----- sensor override addresses /* Multiple sensors can be used by turning each sensor ON in turn and overiding the default address of 0x29 */ const byte North_address = 0x30; const byte East_address = 0x31; // ----- These Arduino pins must be wired to the VL6180X SHDN pin const int North_enable = PA5; // arduino pin A2 const int East_enable = PA6; // arduino pin A3 // ----- sensor info const float Radius = 36; // inside pipe radius (mm) const float North_offset = -6.95; // distance (mm) from centre-line const float East_offset = -35.95; // distance (mm) from centre-line const float Scale = 1.00; // scale factor float North_reading = 0.0; float East_reading = 0.0; float Windspeed = 0.0; float Direction = 0.0; // ----- Filter0 (North Sensor) float Array0[40] = {0}; // array int Index0 = 0; // position of first item float Sum0 = 0.0; // array sum float Average0 = 0.0; // moving average // ----- Filter1 (East Sensor) float Array1[40] = {0}; // array int Index1 = 0; // position of first item float Sum1 = 0.0; // array sum float Average1 = 0.0; // moving average // ----- Filter2 (Direction) float Array2[40] = {0}; // array int Index2 = 0; // position of first item float Sum2 = 0.0; // array sum float Average2 = 0.0; // moving average // ----- Communications const long Baudrate = 115200; // serial comminication speed char Char; // --------------- // setup() // --------------- void setup() { // ----- Initialise communications Serial.begin(115200); Wire.begin(); ekran.init(); ekran.backlight(); ekran.setCursor(0,0); // ----- Configure Arduino pins pinMode(North_enable, OUTPUT); pinMode(East_enable, OUTPUT); // ----- Shutdown sensors digitalWrite(North_enable, LOW); digitalWrite(East_enable, LOW); // ----- Configure North_facing sensor digitalWrite(North_enable, HIGH); // activate sensor delay(50); North.init(); // configure sensor North.configureDefault(); North.setAddress(North_address); // overide the default address North.setTimeout(500); /* ------------ Calibration: ------------ The VL6180X readings can be up to 15mm out To calibrate the sensors: - Comment out code lines 153, 162..168, 198..199 - Uncomment/comment the following two lines - Place an object 50mm in front of the sensor and note the average_reading - Calculate the offset value using the formula "offset=50-average_reading" - Replace the VL6180X::SYSRANGE__PART_TO_PART_RANGE_OFFSET value of 9 with your offset Negative offset values must be expressed in 2's-complement format - Restore/uncomment comments when you are happy with the readings. */ //North.writeReg(VL6180X::SYSRANGE__PART_TO_PART_RANGE_OFFSET,0); // use this offset when calibrating North.writeReg(VL6180X::SYSRANGE__PART_TO_PART_RANGE_OFFSET, 10); North.stopContinuous(); delay(300); North.startRangeContinuous(50); // ------ Configure East_facing sensor digitalWrite(East_enable, HIGH); // activate sensor delay(50); East.init(); // configure sensor East.configureDefault(); East.setAddress(East_address); // change default address East.setTimeout(500); /* ------------ Calibration: ------------ The VL6180X readings can be up to 15mm out To calibrate the sensors: - Comment out code lines 153, 162..168, 198..199 - Uncomment/comment the following two lines - Place an object 50mm in front of the sensor and note the average_reading - Calculate the offset value using the formula "offset=50-average_reading" - Replace the VL6180X::SYSRANGE__PART_TO_PART_RANGE_OFFSET value of 22 with your offset Negative offset values must be expressed in 2's-complement format - Restore/uncomment comments when you are happy with the readings. */ //East.writeReg(VL6180X::SYSRANGE__PART_TO_PART_RANGE_OFFSET,0); East.writeReg(VL6180X::SYSRANGE__PART_TO_PART_RANGE_OFFSET, 19); East.stopContinuous(); delay(300); East.startRangeContinuous(50); // ----- Connect display connect_to_display(); } // --------------- // loop() // --------------- void loop() { // ----- if data is available to read, if (Serial.available() > 0) { Char = (char)Serial.read(); // ----- send data whenever a send character ('S') is received if (Char == 'S') { if (!North.timeoutOccurred()) { North_reading = (float)North.readRangeContinuousMillimeters() - North_offset; Average0 = moving_average(Array0, sizeof(Array0) / sizeof(Array0[0]), &Sum0, &Index0, North_reading); } if (!East.timeoutOccurred()) { East_reading = (float)East.readRangeContinuousMillimeters() - East_offset; Average1 = moving_average(Array1, sizeof(Array1) / sizeof(Array1[0]), &Sum1, &Index1, East_reading); } calculate_speed_direction(Average0, Average1); Average2 = moving_average(Array2, sizeof(Array2) / sizeof(Array2[0]), &Sum2, &Index2, Direction); // ----- send results to the display Serial.print(Windspeed); Serial.print(','); Serial.print(Average2); // Direction Serial.print(','); /* To use these values: - Set the North_offset and East_offset in the Arduino header to zero - Replace the above offset values with these readings - The windspeed indicator should resemble a pin-prick */ Serial.print(Average0 - Radius); // Required North_offset in still air Serial.print(','); Serial.println(Average1 - Radius); // Required East_offset in still air ekran.println(Windspeed); ekran.println("--"); } } } // ---------------------------- // connect to graphics display // ---------------------------- void connect_to_display() { while (Serial.available() 0.001) dY = -dY; if (fabs(E - R * cos(Aci5 * DEG_TO_RAD) - dX) > 0.001) dX = -dX; // ----- Calculate wind direction if ((dX >= 0) && (dY >= 0)) Direction = 270 - Aci6; // quadrant 0 if ((dX = 0)) Direction = 90 + Aci6; // quadrant 1 if ((dX < 0) && (dY = 0) && (dY = array_length) { *array_index = 0; // wrap around } return *array_sum / array_length; // moving average }