Mostly working. Registers the speed, but really slow. Need to either add optimization, or re-order the functions.