FTP: write support

This PR adds write support.

Not complete: proto todo in https://github.com/vooon/mavros/issues/128
This close call will overwrite the errno from the failing open call. Sending the wrong errno back with kErrFailErrno. Need to save off real errno before it gets trashed.