We angles and sequence now

Wow such code 10/10

Merged the angle, soft reset and lock code, did major cleanup and added
lock stages.

Testing this thing is hard.