帮我写一个单片机c51通过3*3的矩阵键盘控制数码管显示1-9，并亮数码管显示数目相同的LED灯的代码

在C51单片机中，我们通常会使用Keypad矩阵键盘和七段数码管以及几个LED灯来实现这种功能。这里给出一个简单的示例，假设我们使用P0口来驱动数码管和部分LED，而键盘的列地址连接到P2口，行地址连接到P1口。以下是基本的程序结构：

#include <reg52.h>
sbit KeyMat[9] = {P2^0, P2^1, P2^2, P2^3, P2^4, P2^5, P2^6, P1^0, P1^1}; //矩阵键盘定义
sbit LED[9]; // LED灯定义

void delay(unsigned int time); //延时函数，你需要自定义它

int get_key_matrix() {
    for (int i = 0; i < 9; ++i) {
        if (KeyMat[i]) return i;
    }
    return -1; // 如果无按键按下，则返回-1
}

void display_num(int num, int led_num) {
    char code[] = {0x3F, 0x06, 0x5B, 0x4F, 0x66, 0x6D, 0x7D, 0x07, 0x7F};
    unsigned char bit = 1 << ((num % 10) * 4);
    Port0 = code[num / 10]; //显示十位数
    Port0 |= code[num % 10]; //显示个位数

    LED[led_num] = 1; //点亮对应的LED
    delay(100); //短暂停留
    LED[led_num] = 0; //关闭LED
}

void main(void) {
    while(1) {
        int key = get_key_matrix(); //获取按键值
        if (key >= 0) {
            display_num(key, key); //数字对应显示并点亮LED
        } else {
            Port0 = 0; //清空数码管显示
            for (int i = 0; i < 9; ++i)
                LED[i] = 0; //关闭所有LED
        }
    }
}

**