now it is working, but axis should be swapped and gyro still have some
work to do, maybe it is missing the "zero" calibration?