Added basic functionality for motor controll, modified configuration for 5506µC.
Added basic functionality for motor controll, modified configuration for 5506µC.