rcS: removed unnecessary sleeps, minor code style fixes

Removed unnecessary sleeps and sleep after starting mavlink. Should be tested carefully before merging.