mb10x0_read.c

Go to the documentation of this file.

#include <breezystm32.h>


void setup()
{
  pwmInit(true, false, false, 490, 1000);
}


void loop()
{
  if (sonarPresent())
  {
    printf("\nsonar read = ");
    for (int i = 0; i < 7; i++)
    {
      float distance = sonarRead(i);
      printf("%d.%dm\t", (int32_t)distance, (int32_t)(distance*1000)%1000);
    }
  }
  else
  {
    printf("\nno sonar");
  }
  delay(50);
}