Add the Wu algorithm

WARRNING!!!
This code is not comleted.