[TubaMorg]

Your link for your COM window is for gmail?

Anyhow, your problem is almost certainly a typecast problem. I haven't run through your code with a fine tooth comb, but these issues almost always trace back to typecast. Is your robot driving ok? In which case the issue is with printf.