Changed a weird bug related to servo angles
Fixed some motor directions. Everything needed to be reversed. What the heck happened??