fix: 完善I2c ReadData函数
This commit is contained in:
		@@ -196,15 +196,15 @@ public class I2c
 | 
			
		||||
    /// </summary>
 | 
			
		||||
    /// <param name="devAddr">I2C设备地址</param>
 | 
			
		||||
    /// <param name="data">要写入的数据(dummy数据)</param>
 | 
			
		||||
    /// <param name="length">要读取的数据长度</param>
 | 
			
		||||
    /// <param name="dataReadLength">要读取的数据长度</param>
 | 
			
		||||
    /// <param name="proto">I2C协议类型</param>
 | 
			
		||||
    /// <returns>操作结果,成功返回读取到的数据,否则返回异常信息</returns>
 | 
			
		||||
    public async ValueTask<Result<byte[]>> ReadData(UInt32 devAddr, byte[] data, int length, I2cProtocol proto)
 | 
			
		||||
    public async ValueTask<Result<byte[]>> ReadData(UInt32 devAddr, byte[] data, int dataReadLength, I2cProtocol proto)
 | 
			
		||||
    {
 | 
			
		||||
        if (length <= 0 || length > 0x0000_FFFF)
 | 
			
		||||
        if (dataReadLength <= 0 || dataReadLength > 0x0000_FFFF)
 | 
			
		||||
        {
 | 
			
		||||
            logger.Error($"Read length {length} is invalid or exceeds maximum allowed 0x0000_FFFF");
 | 
			
		||||
            return new(new ArgumentException($"Read length {length} is invalid or exceeds maximum allowed 0x0000_FFFF"));
 | 
			
		||||
            logger.Error($"Read length {dataReadLength} is invalid or exceeds maximum allowed 0x0000_FFFF");
 | 
			
		||||
            return new(new ArgumentException($"Read length {dataReadLength} is invalid or exceeds maximum allowed 0x0000_FFFF"));
 | 
			
		||||
        }
 | 
			
		||||
 | 
			
		||||
        if (data.Length > 0x0000_FFFF)
 | 
			
		||||
@@ -244,9 +244,9 @@ public class I2c
 | 
			
		||||
            }
 | 
			
		||||
        }
 | 
			
		||||
 | 
			
		||||
        // 配置本次传输数据量:[15:0]为dummy长度(data.Length-1),[31:16]为读长度(length-1)
 | 
			
		||||
        // 配置本次传输数据量:[15:0]为读长度(length-1),[31:16]为dummy长度(data.Length-1)
 | 
			
		||||
        {
 | 
			
		||||
            uint tranConfig = ((uint)(data.Length - 1)) | (((uint)(length - 1)) << 16);
 | 
			
		||||
            uint tranConfig = ((uint)(dataReadLength - 1)) | (((uint)(data.Length - 1)) << 16);
 | 
			
		||||
            var ret = await UDPClientPool.WriteAddr(this.ep, this.taskID, I2cAddr.TranConfig, tranConfig);
 | 
			
		||||
            if (!ret.IsSuccessful)
 | 
			
		||||
            {
 | 
			
		||||
@@ -296,14 +296,14 @@ public class I2c
 | 
			
		||||
 | 
			
		||||
        // 读取数据
 | 
			
		||||
        {
 | 
			
		||||
            var ret = await UDPClientPool.ReadAddr(this.ep, this.taskID, I2cAddr.Read, length);
 | 
			
		||||
            var ret = await UDPClientPool.ReadAddr(this.ep, this.taskID, I2cAddr.Read, dataReadLength);
 | 
			
		||||
            if (!ret.IsSuccessful)
 | 
			
		||||
            {
 | 
			
		||||
                logger.Error($"Failed to read data from I2C FIFO: {ret.Error}");
 | 
			
		||||
                return new(ret.Error);
 | 
			
		||||
            }
 | 
			
		||||
 | 
			
		||||
            if (ret.Value.Options.Data == null || ret.Value.Options.Data.Length != length)
 | 
			
		||||
            if (ret.Value.Options.Data == null || ret.Value.Options.Data.Length != dataReadLength)
 | 
			
		||||
            {
 | 
			
		||||
                logger.Error($"ReadAddr returned unexpected data length: {ret.Value.Options.Data?.Length ?? 0}");
 | 
			
		||||
                return new(new Exception("Failed to read expected amount of data from I2C FIFO"));
 | 
			
		||||
 
 | 
			
		||||
		Reference in New Issue
	
	Block a user