Simplify formula
Use matrix instead of rotate
Rotate around center point