Work in progress 8051 debug stub