Working on fix, got it working but having trouble putting the square in the right spot when rotated...
Solved. I was seriously overthinking it.