Added a madgwick filter, now the default in script