Cleanup
Don't process internal M114 through onecmd() but send them directly
Fix M114 handling for Marlin and cleanup