Feature/ardupilotmega ros pkg