You Are sending twice the same code and then you compare code1 with code to see if same value. This is wise but is giving you problem with the synchronism since you have no handshaking.

Suggestion: remove the compare feature and work with a single byte sent. If your code works has you expect then re-install the double sending feature and try with a higher baud rate (9600) and with a delay between the first byte and the second one (this on the device that Tx the byte)

Cheers

Al.