Debug is working with disabled servo module
Simple debug is running
Improved debug funcionality