Bug fixes:
- Communication with remote not updating setpoints
- Command Line not updating KPIDs due wrong variable type

New MPU6050 initialization:
Now retrieving a given number of values to acount for initial
drifting