mirror of
https://github.com/sunnypilot/sunnypilot.git
synced 2026-02-28 07:04:06 +08:00
8e8f61ad35
* ife is up * split out cdm, bps needs this too * straight to vipc buffer * start reducing the diff * support both * disable for now * cleanup --------- Co-authored-by: Comma Device <device@comma.ai>
34 lines
965 B
C++
34 lines
965 B
C++
#include "cdm.h"
|
|
|
|
int write_cont(uint8_t *dst, uint32_t reg, std::vector<uint32_t> vals) {
|
|
struct cdm_regcontinuous_cmd *cmd = (struct cdm_regcontinuous_cmd*)dst;
|
|
cmd->cmd = CAM_CDM_CMD_REG_CONT;
|
|
cmd->count = vals.size();
|
|
cmd->offset = reg;
|
|
cmd->reserved0 = 0;
|
|
cmd->reserved1 = 0;
|
|
|
|
uint32_t *vd = (uint32_t*)(dst + sizeof(struct cdm_regcontinuous_cmd));
|
|
for (int i = 0; i < vals.size(); i++) {
|
|
*vd = vals[i];
|
|
vd++;
|
|
}
|
|
|
|
return sizeof(struct cdm_regcontinuous_cmd) + vals.size()*sizeof(uint32_t);
|
|
}
|
|
|
|
int write_random(uint8_t *dst, std::vector<uint32_t> vals) {
|
|
struct cdm_regrandom_cmd *cmd = (struct cdm_regrandom_cmd*)dst;
|
|
cmd->cmd = CAM_CDM_CMD_REG_RANDOM;
|
|
cmd->count = vals.size() / 2;
|
|
cmd->reserved = 0;
|
|
|
|
uint32_t *vd = (uint32_t*)(dst + sizeof(struct cdm_regrandom_cmd));
|
|
for (int i = 0; i < vals.size(); i++) {
|
|
*vd = vals[i];
|
|
vd++;
|
|
}
|
|
|
|
return sizeof(struct cdm_regrandom_cmd) + vals.size()*sizeof(uint32_t);
|
|
}
|