The robot pose was not updating based on wheel movement or gyro changes. This was fixed and can now move in correct direction and displays correct orientation in advantagekit.
Problems still include drifting and incorrect scaling values. Robot moves correctly around the field but the conversion to the real world may not be correct.
The robot pose was not updating based on wheel movement or gyro changes. This was fixed and can now move in correct direction and displays correct orientation in advantagekit.
Problems still include drifting and incorrect scaling values. Robot moves correctly around the field but the conversion to the real world may not be correct.
Fixes #24