Re-add LCD bits to stm-demo