I was using anagles instead of radians when calculating with sin/cos.. stupid mistake.