Hier ist eine gute Einleitung mit einem Codebeispiel für einen ähnlichen Treiber:
http://www.instructables.com/id/Monster-Motor-Shield-VNH2SP30/