基于矩阵按键和数码管实现的简易加减法计算-Calculated based on the matrix keys and digital realization of simple addition and subtraction

对矩阵欧氏距离及灰色关联度的计算，学完C++的同学可以利用此例程提高水平-Euclidean distance matrix calculation and gray associated degree, completion of C++ students can use this routine to raise the level

使用四元数计算各个时刻的姿态数据，并能在欧拉角和四元数，旋转矩阵之间转换，通过地磁数据校正陀螺仪算出的姿态。MADGWICKAHRS Implementation of Madgwick s IMU and AHRS algorithms-MADGWICKAHRS Implementation of Madgwick s IMU and AHRS algorithms

1）在LCD屏幕上提示用户用矩阵键盘输入6个数字，输入过程显示在屏幕上，同时从左到右显示在扩展版的数码管上。输入完成后，屏幕提示按“确认”键开始排序过程。一定要输满6个数字才能排序；输入过程中若按“取消”键则清除所有输入结果，回到待机状态。 （2）当输入完6个数字，按下“确认”键后，程序开始排序；在排序过程中在数码管上显示中间结果，每当数字顺序发生变化时，显示在数码管上停留3秒或有按键按下后才进行下一步计算。 （3）排序结束后，在数码管上应该从左到右显示数值从小到大排列的6个数字，同时L