compAIR/libcreate
compAIR/libcreate
4
0
Fork 1
Code Issues Pull requests Projects Releases Packages 1 Wiki Activity Actions

Update wheeldrop example

Browse source 
Now prints status of each wheel to screen.

Signed-off-by: Jacob Perron <jacobmperron@gmail.com>
This commit is contained in:
Jacob Perron 2019-08-26 21:09:59 -07:00 • committed by Jacob Perron
parent 4a0f8ad72b
commit fd2f05047e
1 changed files with 8 additions and 3 deletions
Download patch file Download diff file Expand all files Collapse all files

11
examples/wheeldrop.cpp
View file

@ -64,13 +64,18 @@ int main(int argc, char** argv) {
while (!robot->isCleanButtonPressed()) {
// Get wheeldrop status
const bool wheeldrop = robot->isWheeldrop();
const bool wheeldrop_left = robot->isLeftWheeldrop();
const bool wheeldrop_right = robot->isRightWheeldrop();
// Print status
std::cout << "\rWheeldrop status: " << wheeldrop;
std::cout << "\rWheeldrop status (left and right): [ " <<
wheeldrop_left <<
", " <<
wheeldrop_right <<
" ]";
// If dropped, then make light red
if (wheeldrop)
if (wheeldrop_left || wheeldrop_right)
robot->setPowerLED(255); // Red
else
robot->setPowerLED(0); // Green