Refined the code, added some instructions

Add and And instructions are not tested yet.