Adding the 50hz servo (and example in the main)
Adding dumpcode & interrupt