Tidying up

Made new files for quad_control, moved beep function to debug.