Code cleaned and mpu read woriking, miloc, use this ONE!