All instructions implemented. The problem was that I had switched the subtract terms around. Now correct