IR sensor implementation problem

Hi-,

Recently I tried to add IR sensors to APM board for obstacle avoidance. I am using an APM1 board, and an expansion port on the IMU shield board to receive analog-in data from an IR sensor. A Maxsonar is hook up too.

Then I used the visual micro debugger to read out the variable values. I found that SharpIR_dist kept being 20 without any change, which means the IR sensor is never working. Any help? Thanks in advance.

The codes I added in the program are as below:
In the ArduCopter.pde:
#define SharpIR_trigger 60
#define CONFIG_SHARPIR_SOURCE_ADC_CHANNEL 6 // on expansion ports

ModeFilterInt16_Size5 SharpIR_mode_filter(2);
AP_AnalogSource_ADC SharpIR_analog_source(&adc, CONFIG_SHARPIR_SOURCE_ADC_CHANNEL, 1);
AP_RangeFinder_SharpGP2Y SharpIR(&SharpIR_analog_source, &SharpIR_mode_filter);

static int16_t SharpIR_dist;
static bool obstacle = false;

SharpIR_dist = SharpIR.read();
if(SharpIR_dist <= SharpIR_trigger) // obstacle detected in front
obstacle = true;
else
obstacle = false;

In the Attitude.pde:
if(obstacle)
target_angle += 3000; // increase roll angle by 30 deg if obstacle detected, to keep away from the obstacle

A debugging screen capture is attached.

Thanks,-yangbo

irsensor.jpg

You need to be a member of diydrones to add comments!

Join diydrones

Email me when people reply –

Replies

  • Hi! I try to implement my IR sensors on my code and wondered where you put those lines in Attitude.pde :

    if(obstacle)
    target_angle += 3000; // increase roll angle by 30 deg if obstacle detected, to keep away from the obstacle

    Did you create a new function for obstacle avoidance or did you just add those lines in an already existing function like "get_stabilize_roll"?

    I'm a beginner and i'm looking for some help! :)

    Cheers.

This reply was deleted.

Activity

DIY Robocars via Twitter
yesterday
DIY Robocars via Twitter
Saturday
DIY Robocars via Twitter
Saturday
DIY Robocars via Twitter
RT @f1tenth: Say hi to our newest #F1TENTH creation for @ieee_ras_icra next week in Philly. It’s going to be huge! 😎 🔥 @AutowareFdn @PennEn…
Saturday
DIY Robocars via Twitter
May 11
DIY Robocars via Twitter
May 8
DIY Robocars via Twitter
RT @SmallpixelCar: Noticed my car zigzagged in last run. It turned out to be the grass stuck in the wheel and made the odometry less accura…
May 8
DIY Robocars via Twitter
RT @SmallpixelCar: Test my car. RTK GPS worked great. Thanks @emlid for their support. https://t.co/EkQ6qmjmWR
May 8
DIY Drones via Twitter
RT @chr1sa: @kane That's @diydrones circa 2009. Still have a box of those Canon cameras that we used to strap into planes, just like this.…
May 3
DIY Robocars via Twitter
RT @chr1sa: Our next @diyrobocars race is going to be outside at a real RC racetrack in Fremont on May 28. Fully autonomous racing, head-to…
Apr 30
DIY Robocars via Twitter
RT @f1tenth: Our Spring 2022 F1TENTH course @PennEngineers is coming to an end with a head-to-head race as a big finale. So proud of our st…
Apr 26
DIY Robocars via Twitter
RT @DanielChiaJH: I wrote a thing! Throughout the development of my @diyrobocars car I've been using @foxglovedev Studio to visualize and d…
Apr 23
DIY Robocars via Twitter
RT @SmallpixelCar: My new car for high speed. Low body, everything ( @NVIDIAEmbedded Jetson Xavier NX, @emlid RTK GPS, IMC) under the deck…
Apr 23
DIY Robocars via Twitter
Apr 21
DIY Robocars via Twitter
RT @f1tenth: F1TENTH Race training setup @PennEngineers for our upcoming ICRA2022 @ieee_ras_icra competition. @OpenRoboticsOrg @IndyAChalle…
Apr 21
DIY Robocars via Twitter
RT @fatcatFABLAB: Proud to be hosting a restarted DIY Robocars NYC Meetup April 26. Come by if you want to talk about and race self-driving…
Apr 17
More…