Add font upload function. Add mavlink process in main