Optimization: GPIO functions changed to direct IO access in motor module
Fixed errors
Optimization: GPIO functions changed to direct IO access in motor module
Optimization: GPIO functions changed to direct IO access in motor module
Deleted commented blocks in motor module