FTOF reconstruction code works now