Вам компас менять нужно. На М1 он находится в носу дрона. Также, будет не лишним поменять IMU модуль. Это относительно кривого полета, но начните с компаса.
Хм, в других местах я нашёл информацию что менять нужно задний компас, который с GPS. Вы уверены что всё-таки передний?