Commit 08d2495

committed

ModulinoDistance: add available() API

available() returns true is the distance is retrieved and is valid; get() returns now the last value read.

1 parent 84c98f3 commit 08d2495Copy full SHA for 08d2495

File tree

-6

lines changed

-6

lines changed

Lines changed: 9 additions & 6 deletions

Original file line number	Diff line number	Diff line change
`@@ -412,26 +412,29 @@ class ModulinoDistance : public Module {`
`412`	`412`	`operator bool() {`
`413`	`413`	`return (tof_sensor != nullptr);`
`414`	`414`	`}`
`415`		`- floatget() {`
	`415`	`+ boolavailable() {`
`416`	`416`	`if (tof_sensor == nullptr) {`
`417`		`- return NAN;`
	`417`	`+ return false;`
`418`	`418`	`}`
	`419`	`+ float ret = internal;`
`419`	`420`	`uint8_t NewDataReady = 0;`
`420`	`421`	`tof_sensor->VL53L4CD_CheckForDataReady(&NewDataReady);`
`421`	`422`	`if (NewDataReady) {`
`422`	`423`	`tof_sensor->VL53L4CD_ClearInterrupt();`
`423`	`424`	`tof_sensor->VL53L4CD_GetResult(&results);`
`424`	`425`	`}`
`425`	`426`	`if (results.range_status == 0) {`
`426`		`- return results.distance_mm;`
	`427`	`+ internal = results.distance_mm;`
`427`	`428`	`} else {`
`428`		`- return NAN;`
	`429`	`+ internal = NAN;`
`429`	`430`	`}`
	`431`	`+ return !isnan(internal);`
`430`	`432`	`}`
`431`		`- boolisValid(float distance) {`
`432`		`- return !isnan(distance);`
	`433`	`+ float get() {`
	`434`	`+ return internal;`
`433`	`435`	`}`
`434`	`436`	`private:`
`435`	`437`	`VL53L4CD* tof_sensor = nullptr;`
`436`	`438`	`VL53L4CD_Result_t results;`
	`439`	`+ float internal = NAN;`
`437`	`440`	`};`

Comments

(0)