FrSky SmartPort bugfix

There was byte stuffing missing which could cause sporadic ommision of certain telemetry values (when they contained critical bytes).
Agreed, generaly speaking this is definitely not good practice.  But reason was these two functions are static, tightly coupled and close each other in the source file, therefore I find this as acceptable. I'll add comment.