Avec le code s'est effectivement mieux.
La mega possède nativement 4 liens série matériels donc il vaudrait mieux utiliser Serial1, Serial2 ou Serial3 plutôt qu'un lien série Software.
De plus, si tu lis la doc de SoftwareSerial tu verras que l'on ne peut pas utiliser n'importe quelle I/O pour réaliser une UART avec SoftwareSerial (voir la partie Limitations).