First code of prototype 3 (still with LPc2103). The motor works, but not always it start as it should. Current control seems to work well.