Separated input and physics, added stagger routine

Also, non-grounded ground checks now just use the sensors as points