Implement enable & direction control for motors

Ahoj,

tohle by mělo přidat podporu pro řízení směru motorů. Narazil jsem na to při dělání linefollowera - jak to chápu, předtím by se motor jenom zastavil na místě.

Ještě ten kód budu trochu upravovat; chtěl bych ho upravit, aby více využíval hw_defs modul, do kterého jsem se snažil zanést informace ze schémat.

Kuba