@Rehaan, @vk2tds, that code was just a fix of some Arduino I did for @arduima since he was having RAM problems.
He tells me it works but it is by no means robust and I agree with @vk2tds that a combination of the two would be ideal.