Added debugging module. Updated motor control.