changed all vectors to use javax.vecmath