Feature re-arrange for Mega

1.add ESC cal delays for each func