Magic carpet handling functioning.

git-svn-id: https://chibios.svn.sourceforge.net/svnroot/chibios/trunk@5156 35acf78f-673a-0410-8e92-d51de3d6d3f4