Hello sir !!
I can do this task for you, i have skills with assembly and i tallent you can check my profile, I am endowed for the programming (assembler).
i just need how do you want to do that i prpose to work with ISIS as a simulator and with microship or we can program all microcontrollers's assembly.
I can send you after a video, in this way you can be sur that it work