Fixed magnitude of 0 issue
Fixed qsin qcos
Fixed trigs