M112 now works

Linked emergency stop routine to M112
Merge branch 'T3P3-selected_head_changes' into selected_head_changes

Conflicts:
	GCodes.cpp