@bearer
Would just like to say thanks to Bearer for his help, I ended up using the CS5 pin on the extension header, and switching it with M42.

Thanks Derek