Dragon Fly 4.1

Added suport for the 6 motor drive and added stuff for tracking.
Revert "Dragon Fly 4.1"

This reverts commit c37b87cc93654f97ac9a16fd8e834d7824f624ef.