Starting to implement code for pseudo code for hardware