struct atmel_tdes_reqctx {
        unsigned long mode;
+       u8 lastc[DES_BLOCK_SIZE];
 };
 
 struct atmel_tdes_dma {
        return err;
 }
 
+static void
+atmel_tdes_set_iv_as_last_ciphertext_block(struct atmel_tdes_dev *dd)
+{
+       struct skcipher_request *req = dd->req;
+       struct atmel_tdes_reqctx *rctx = skcipher_request_ctx(req);
+       struct crypto_skcipher *skcipher = crypto_skcipher_reqtfm(req);
+       unsigned int ivsize = crypto_skcipher_ivsize(skcipher);
+
+       if (req->cryptlen < ivsize)
+               return;
+
+       if (rctx->mode & TDES_FLAGS_ENCRYPT) {
+               scatterwalk_map_and_copy(req->iv, req->dst,
+                                        req->cryptlen - ivsize, ivsize, 0);
+       } else {
+               if (req->src == req->dst)
+                       memcpy(req->iv, rctx->lastc, ivsize);
+               else
+                       scatterwalk_map_and_copy(req->iv, req->src,
+                                                req->cryptlen - ivsize,
+                                                ivsize, 0);
+       }
+}
+
 static void atmel_tdes_finish_req(struct atmel_tdes_dev *dd, int err)
 {
        struct skcipher_request *req = dd->req;
 
        dd->flags &= ~TDES_FLAGS_BUSY;
 
+       atmel_tdes_set_iv_as_last_ciphertext_block(dd);
+
        req->base.complete(&req->base, err);
 }
 
 
 static int atmel_tdes_crypt(struct skcipher_request *req, unsigned long mode)
 {
-       struct atmel_tdes_ctx *ctx = crypto_skcipher_ctx(
-                       crypto_skcipher_reqtfm(req));
+       struct crypto_skcipher *skcipher = crypto_skcipher_reqtfm(req);
+       struct atmel_tdes_ctx *ctx = crypto_skcipher_ctx(skcipher);
        struct atmel_tdes_reqctx *rctx = skcipher_request_ctx(req);
 
        if (mode & TDES_FLAGS_CFB8) {
 
        rctx->mode = mode;
 
+       if (!(mode & TDES_FLAGS_ENCRYPT) && req->src == req->dst) {
+               unsigned int ivsize = crypto_skcipher_ivsize(skcipher);
+
+               if (req->cryptlen >= ivsize)
+                       scatterwalk_map_and_copy(rctx->lastc, req->src,
+                                                req->cryptlen - ivsize,
+                                                ivsize, 0);
+       }
+
        return atmel_tdes_handle_queue(ctx->dd, req);
 }