added position encoding with a separate task in position.c and position.h. Not tested yet with full power, so check the Task speed. 1ms at the moment.