changed up how the lock works
fixed up the inverted bits of motors and servos