Obstacle avoidance with Sonar

Will Fellmeth July 13, 2016 at 4:51am

Discussion update:

This post, back in late 2013 early 2014, was intended to probe the challenges involved with engineering and designing a quad, that would be flying fully autonomously beyond line of sight in the Swiss Alps, that could see and avoid obstacles that where unknown to the flight planner. Since then my involvement in the project, QuadForge (http://www.quadforge.net/), has declined to a minimum and the project has moved in other directions.

Consequentially, I have not made progress into such endeavors as obstacle avoidance. I am however very interested in terrain following with Lidar (such as seen here: http://diydrones.com/profiles/blogs/terrain-following-missions-usin...) or with sonar for applications within open pit mines and quarries and intend to develop a system for it in the near future for my newest employment and to begin a discussion on this topic as well.

Cheers,

Will F

東京都でストーカー対策は探偵事務所に相談しよう！

東京都でストーカー対策は原一探偵事務所に相談しよう！

Muneeb Abbasi July 12, 2016 at 12:32pm

Hello,

I have successfully run 5 sonars on my quadcopter using the NEWPING library on arduinomega 2560 board. Can any body help me how to integrate my arduinomega 2560 with APM 2.8 so that the quadcopter would react accordingly. I think that this can be done using telemetry radio and a PPM encoder but I need the code for integrating the system. I am actually trying to implement obstacle avoidance.

The following code can be used for obstacle avoidance:


#include<Servo.h>
	Servo aileron,elevator;
	int setpoint=60,Kp=3;
	void setup()
	{
	Serial.begin(9600);
	aileron.attach(9);
	elevator.attach(10);
	}
	void loop()
	{
	int left,right,front,back;
	int d1,d2,d3,d4;
	int temp,temp1,temp2,temp3;
	int e1,e2,e3,e4;
	int op1,op2,op3,op4,opx,opy;
	temp=0;
	temp1=0;
	temp2=0;
	temp3=0;
	for(int i=0;i=10;i++)
	{
	left = analogRead(A0);
	temp=temp+left;
	}
	d1=temp/10;
	for(int i=0;i=10;i++)
	{
	right = analogRead(A1);
	temp1=temp1+right;
	}
	d2=temp1/10;
	for(int i=0;i=10;i++)
	{
	front = analogRead(A2);
	temp2=temp2+front;
	}
	d3=temp2/10;
	for(int i=0;i=10;i++)
	{
	back = analogRead(A3);
	temp3=temp3+back;
	}
	d4=temp3/10;

	e1=d1-setpoint;
	e2=d2-setpoint;
	e3=d3-setpoint;
	e4=d4-setpoint;

	op1=e1*Kp;
	op2=e2*Kp;
	op3=e3*Kp;
	op4=e4*Kp;

	opx=1500-op1+op2;
	opy=1500-op3+op4;

	aileron.writeMicroseconds(opx);
	elevator.writeMicroseconds(opy);
	Serial.println(left);
	Serial.println(right);
	Serial.println(front);
	Serial.println(back);



	}

regards!

Dan Neault December 13, 2013 at 10:06am

Can't be done, no room in APM, PIX maybe.

See my other posts for a picture of a sonar set up. The code to pulse the sensors, determine good data from bad, and command the quad, gets long and very involved,

With APM, I had to add another Arduino, but it does work (very well in fact).

Good luck :)

Felixrising > Dan Neault March 10, 2014 at 10:49pm

Bump, with Pixhawk here, and with great sensors like LIDAR-Lite, Pixy (CMUcam5) and PX4Flow, Other Maxbotix sonars, etc.. time to kick off a project for sensor integration.. lets call it .... drum roll.... "Project Dodgem" ;)

Discussions

Obstacle avoidance with Sonar

Replies

Activity