FTP: write support

This PR adds write support.

Not complete: proto todo in https://github.com/vooon/mavros/issues/128
Returning bytes written in payload->size seems bad. I'd rather see the commented out code method instead.