Looks to me like you guys might be on the right direction to fixing this problem.
As I stated before, there has to be a way to separate the forward / reverse speed from the prop rotation. When you guys can do that, you can get the sub to move forward/reverse without prop rotation or have prop rotation in either direction without sub movement.
Once you can control each independently, you can set each to work the correct way.