Final version for iMX6 . Not tested yet.