I made one!

Best way to do it is use vtols it's the simplest and effective

Wow! Thanks @FlyingThings

Just simply dont make it float. Leave the hull normal. To dive, and swim, put floaters on long rods that connect to rotators. If the rotators move the floaters up, then the sub moves down.