Fixed bug in six axis calculations