Found something wrong with sin and cos