Port To Rv2

This is a quick port to RV2
Updated to algos Fixed typos