added matlab update quaternion normalization
still working on serial, use arduino playground