я думаю, что еще гироскоп потребуется. Вообще этой задачей занимается любой коптер, поэтому можно изучить исходники проектов коптеров (они есть на ардуине) и выдрать оттуда нужный кусок.