123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878 |
- #include <linux/kernel.h>
- #include <linux/errno.h>
- #include "ktiva.h"
- #include "ksync.h"
- /////////////////////////////////////////////////////////////////////////////
- #define _SQUARE_COEFFICIENT 6
- #define _LINEAR_COEFFICIENT 400
- /////////////////////////////////////////////////////////////////////////////
- extern int g_sw;
- /////////////////////////////////////////////////////////////////////////////
- static const long g_kty_tab[][2] =
- {
- {199, 1250},
- {351, 1000},
- {643, 750},
- {1185, 500},
- {2048, 250},
- {3025, 0},
- {3705, -250}
- };
- #define KTY_TAB_LEN _countof(g_kty_tab)
- /////////////////////////////////////////////////////////////////////////////
- static int _lin_kty(int resistance)
- {
- int i;
- if(resistance <= g_kty_tab[0][0])
- return(g_kty_tab[0][1]);
- else if(resistance >= g_kty_tab[KTY_TAB_LEN - 1][0])
- return(g_kty_tab[KTY_TAB_LEN - 1][1]);
- for(i = 1; i < KTY_TAB_LEN; i++)
- {
- if(g_kty_tab[i][0] >= resistance)
- break;
- }
- // linear interpolation
- return g_kty_tab[i - 1][1] + // y1 +
- ( // (
- (g_kty_tab[i][1] - g_kty_tab[i - 1][1]) * // (y2 - y1) *
- (resistance - g_kty_tab[i - 1][0]) / // (x - x1) /
- (g_kty_tab[i][0] - g_kty_tab[i - 1][0]) // (x2 - x1)
- ); // )
- }
- /////////////////////////////////////////////////////////////////////////////
- #if _SCALE_DISPLAY_DUTY_CYCLE
- static unsigned int _ScaleDutyCycle(unsigned int nPeriod, unsigned int nDutyCyclePerc)
- {
- if(nDutyCyclePerc < 0)
- nDutyCyclePerc = 0;
- else if(nDutyCyclePerc > 100)
- nDutyCyclePerc = 100;
- return (_SQUARE_COEFFICIENT * nDutyCyclePerc * nDutyCyclePerc + _LINEAR_COEFFICIENT * nDutyCyclePerc) / 1000 * nPeriod / 100;
- }
- #else // _SCALE_DISPLAY_DUTY_CYCLE
- static unsigned int _ScaleDutyCycle(unsigned int nPeriod, unsigned int nDutyCyclePerc)
- {
- if(nDutyCyclePerc < 0)
- nDutyCyclePerc = 0;
- else if(nDutyCyclePerc > 100)
- nDutyCyclePerc = 100;
- return nDutyCyclePerc * nPeriod / 100;
- }
- #endif // _SCALE_DISPLAY_DUTY_CYCLE
- /////////////////////////////////////////////////////////////////////////////
- static int _scale(int in_min, int in_max, int out_min, int out_max, int wert)
- {
- int abc;
- abc = (((long)out_max - (long)out_min) * (long)wert) / ( (long)in_max - (long)in_min);
- abc = abc + out_min;
- return abc;
- }
- /////////////////////////////////////////////////////////////////////////////
- /////////////////////////////////////////////////////////////////////////////
- /////////////////////////////////////////////////////////////////////////////
- int ktiva_wait_ack(struct file *pf)
- {
- int ret, i = 0;
- unsigned char c = 0;
- #if _SITARA_EGGELSBERG
- unsigned long start = jiffies;
- unsigned long timeout = jiffies + 4;
- #else // _SITARA_EGGELSBERG
- unsigned long timeout = jiffies + 2 *HZ; // 2 sec. timeout
- #endif // _SITARA_EGGELSBERG
- while(c != CMD_ACK)
- {
- ++i;
- ksync_sleep_jiffies(1);
- if((ret = kspi_rx_byte(pf, &c)) < 0)
- return ret;
- else if(c == CMD_NAK)
- {
- KALERT("%s: received NAK!\n", __FUNCTION__);
- return -ECOMM;
- }
- else if(c != CMD_ACK)
- {
- if(time_is_before_eq_jiffies(timeout))
- {
- KALERT("%s: timeout!\n", __FUNCTION__);
- return -ETIME;
- }
- }
- }
- #if _SITARA_EGGELSBERG
- KALERT("ktiva_wait_ack: jiffies: %lu, loops: %d\n", ((long)jiffies - (long)start), i);
- #endif // _SITARA_EGGELSBERG
- return (c == CMD_ACK) ? 0 : -1;
- }
- /////////////////////////////////////////////////////////////////////////////
- int ktiva_send_frame(struct file *pf, unsigned char cmd, const void *pData, size_t nCbData)
- {
- int ret;
- size_t i, j = 0;
- unsigned char buf[KTIVA_MAX_BUFFER_SIZE];
- const unsigned char *pdat = (const unsigned char*)pData;
- #if _EXTENDED_ERROR_CHECK
- if(nCbData > (sizeof(buf) - 3))
- {
- KALERT("%s: Invalid data length: %zu!\n", __FUNCTION__, nCbData);
- return -ENOMEM;
- }
- else if(nCbData && !pData)
- {
- KALERT("%s: Invalid data pointer!\n", __FUNCTION__);
- return -EINVAL;
- }
- #endif // _EXTENDED_ERROR_CHECK
- buf[0] = (unsigned char)nCbData + 3;
- buf[1] = cmd; // init checksum
- buf[2] = cmd;
- for(i = 0, j = 3; i < nCbData; ++i, ++j)
- {
- buf[1] += pdat[i]; // calc checksum
- buf[j] = pdat[i]; // fill in data
- }
- if((ret = kspi_tx(pf, buf, j)) < 0) // send data frame
- return ret;
- if((ret = ktiva_wait_ack(pf)) == 0) // wait for ACK
- ret = (int)nCbData;
- return ret;
- }
- /////////////////////////////////////////////////////////////////////////////
- int ktiva_recv_frame(struct file *pf, unsigned char cmd, void *pData, size_t nCbData)
- {
- int ret, i;
- unsigned char chk = 0, len = 0;
- unsigned char buf[KTIVA_MAX_BUFFER_SIZE];
- unsigned long timeout = jiffies + HZ; // 1 sec. timeout
- #if _EXTENDED_ERROR_CHECK
- if(nCbData && !pData)
- {
- KALERT("%s: Invalid data pointer!\n", __FUNCTION__);
- return -EINVAL;
- }
- #endif // _EXTENDED_ERROR_CHECK
- do
- {
- if((ret = kspi_rx_byte(pf, &len)) < 0) // receive length byte
- return ret;
- if(!len)
- {
- ksync_sleep_jiffies(1);
- if(time_is_before_eq_jiffies(timeout))
- {
- KALERT("%s: timeout!\n", __FUNCTION__);
- return -ETIME;
- }
- }
- }
- while(!len);
- if(len > (int)(nCbData + 3))
- {
- KALERT("%s: Insufficient buffer length: %zu - need %hhu!\n", __FUNCTION__, nCbData, len - 3);
- return -EINVAL;
- }
- else if(len < 2)
- {
- KALERT("%s: received invalid lenght: %hhu!\n", __FUNCTION__, len);
- return -EPROTO;
- }
- if((ret = kspi_rx(pf, buf, len - 1)) < 0) // receive checksum, cmd + data
- return ret;
- else if(ret != (len - 1))
- {
- KALERT("%s: kspi_rx returned invalid lenght: %d!\n", __FUNCTION__, ret);
- return -EPROTO;
- }
- else if(buf[1] != cmd)
- {
- KALERT("%s: invalid command: %02hhX!\n", __FUNCTION__, buf[1]);
- return -EPROTO;
- }
- // KALERT("ktiva_recv_frame: ordered: %hhu, received: %d!\n", len - 1, ret);
- for(i = 1; i < ret; ++i)
- {
- chk += buf[i]; // calc checksum
- }
- if(buf[0] != chk)
- {
- KALERT("%s: checksum err: [l=%hhu, c=0x%02hhX], recv: 0x%02hhX, calc: 0x%02hhX!\n", __FUNCTION__, len, buf[1], buf[0], chk);
- #if 1
- for(i = 2; i < ret; ++i)
- KALERT("%02hhX ", buf[i]);
- KALERT("\n");
- #endif // _SITARA_EGGELSBERG
- return -EPROTO;
- }
- if(nCbData)
- memcpy(pData, &buf[2], ret - 2);
- // KALERT("%s: jiffies: %lu\n", __FUNCTION__, ((long)jiffies - (long)start));
- return ret - 2;
- }
- /////////////////////////////////////////////////////////////////////////////
- int ktiva_recv_bootloader_frame(struct file *pf, unsigned char cmd, void *pData, size_t nCbData)
- {
- int ret, i;
- unsigned char chk = 0, len = 0;
- unsigned char buf[KTIVA_MAX_BUFFER_SIZE];
- // unsigned long start = jiffies;
- unsigned long timeout = jiffies + HZ; // 1 sec. timeout
- #if _EXTENDED_ERROR_CHECK
- if(nCbData && !pData)
- {
- KALERT("%s: Invalid data pointer!\n", __FUNCTION__);
- return -EINVAL;
- }
- #endif // _EXTENDED_ERROR_CHECK
- do
- {
- if((ret = kspi_rx_byte(pf, &len)) < 0) // receive length byte
- return ret;
- if(!len)
- {
- ksync_sleep_jiffies(1);
- if(time_is_before_eq_jiffies(timeout))
- {
- KALERT("%s: timeout!\n", __FUNCTION__);
- return -ETIME;
- }
- }
- }
- while(!len);
- if(len > (int)(nCbData + 2))
- {
- KALERT("%s: Insufficient buffer length: %zu - need %hhu!\n", __FUNCTION__, nCbData, len - 3);
- return -ENOMEM;
- }
- else if(len < 2)
- {
- KALERT("%s: received invalid lenght: %hhu!\n", __FUNCTION__, len);
- return -EPROTO;
- }
- if((ret = kspi_rx(pf, buf, len - 1)) < 0) // receive checksum + data
- return ret;
- else if(ret != (len - 1))
- {
- KALERT("%s: kspi_rx returned invalid lenght: %d!\n", __FUNCTION__, ret);
- return -EPROTO;
- }
- for(i = 1; i < ret; ++i)
- {
- chk += buf[i]; // calc checksum
- }
- if(buf[0] != chk)
- {
- KALERT("%s: checksum error: recv: 0x%02hhX, calc: 0x%02hhX!\n", __FUNCTION__, buf[0], chk);
- return -EPROTO;
- }
- if(nCbData)
- memcpy(pData, &buf[1], ret - 1);
- return ret - 1;
- }
- /////////////////////////////////////////////////////////////////////////////
- /////////////////////////////////////////////////////////////////////////////
- int TivaRevive(struct file *pf)
- {
- int ret, i = 0;
- unsigned char c = 0;
- for(i = 0; i < 256; ++i)
- {
- if((ret = kspi_rx_byte(pf, &c)) < 0)
- {
- KALERT("%s - kspi_rx_byte failed: %d\n", __FUNCTION__, ret);
- return ret;
- }
- else if(c == CMD_ACK)
- break;
- else if(c == CMD_NAK)
- {
- KALERT("%s: received NAK\n", __FUNCTION__);
- break;
- }
- if(i && !(i % 8))
- {
- ksync_sleep_jiffies(1);
- }
- }
- if(i == 256)
- {
- if((ret = kspi_tx_byte(pf, CMD_ACK)) < 0)
- {
- KALERT("%s - kspi_tx_byte failed: %d\n", __FUNCTION__, ret);
- return ret;
- }
- }
- KALERT("%s: loops: %d\n\n", __FUNCTION__, i);
- return (c == CMD_ACK) ? 0 : -1;
- }
- /////////////////////////////////////////////////////////////////////////////
- int TivaCmdGetDeviceCaps(struct file *pf, LPTIVA_DCAP pDCap)
- {
- int ret;
- unsigned int did0 = 0xFFFFFFFF, did1 = 0xFFFFFFFF, dc0 = 0xFFFFFFFF;
- if((ret = TivaCmdGetAddress(pf, KTIVA_DID0_ADDRESS, &did0)))
- {
- KALERT("%s - TivaCmdGetAddress failed: %d\n", __FUNCTION__, ret);
- return ret;
- }
- else if((ret = TivaCmdGetAddress(pf, KTIVA_DID1_ADDRESS, &did1)))
- {
- KALERT("%s - TivaCmdGetAddress failed: %d\n", __FUNCTION__, ret);
- return ret;
- }
- else if((ret = TivaCmdGetAddress(pf, KTIVA_DCAP0_ADDRESS, &dc0)))
- {
- KALERT("%s - TivaCmdGetAddress failed: %d\n", __FUNCTION__, ret);
- return ret;
- }
-
- pDCap->did0 = did0;
- pDCap->did1 = did1;
- pDCap->dc0 = dc0;
- return ret;
- }
- /////////////////////////////////////////////////////////////////////////////
- int TivaCmdGetFirmwareVersion(struct file *pf, int *Hw, int *Sw)
- {
- int ret;
- if((ret = ktiva_send_frame(pf, COMMAND_GET_HWSW_REV, NULL, 0)) == 0)
- {
- int data[2];
- if((ret = ktiva_recv_frame(pf, COMMAND_GET_HWSW_REV, data, sizeof(data))) == sizeof(data))
- {
- if(Hw)
- *Hw = ntohl(data[0]);
- if(Sw)
- *Sw = ntohl(data[1]);
- kspi_tx_byte(pf, CMD_ACK);
- ret = 0;
- }
- else
- {
- KALERT("%s - ktiva_recv_frame failed: %d\n", __FUNCTION__, ret);
- }
- }
- else
- {
- KALERT("%s - ktiva_send_frame failed: %d!\n", __FUNCTION__, ret);
- }
- return ret;
- }
- /////////////////////////////////////////////////////////////////////////////
- int TivaCmdGetADC(struct file *pf, LPTIVA_ADC padc)
- {
- int ret;
- #if _EXTENDED_ERROR_CHECK
- if(!padc)
- {
- KALERT("%s: Invalid struct pointer!\n", __FUNCTION__);
- return -EINVAL;
- }
- #endif // _EXTENDED_ERROR_CHECK
- if((ret = ktiva_send_frame(pf, COMMAND_GET_ADC, NULL, 0)) == 0)
- {
- unsigned short data[6];
- if((ret = ktiva_recv_frame(pf, COMMAND_GET_ADC, data, sizeof(data))) == sizeof(data))
- {
- padc->UVers = _scale(0, 4096, 0, 4375, ntohs(data[0])); // val / 100.0 + 0.4 (Versorgungsspannung skaliert)
- padc->UBatV3 = _scale(0, 4096, 0, 500, ntohs(data[1])); // val / 100.0 (Spannung Pufferbatterie skaliert)
- padc->Temp = _lin_kty(ntohs(data[2])); // val / 10.0 (Boardtemperatur linear interpoliert)
- padc->UV5Vsys = _scale(0, 4096, 0, 570, ntohs(data[3])); // val / 100.0 (interne 5V Hauptversorgungsspannung skaliert)
- padc->UV3V6Bat = _scale(0, 4096, 0, 500, ntohs(data[4])); // val / 100.0 (interne 3V Akkuspannung skaliert)
- padc->TempTIVA = ntohs(data[5]); // 147.5 - 187.5 * val / 4096.0 (TIVA-Temperatur)
- kspi_tx_byte(pf, CMD_ACK);
- ret = 0;
- }
- else
- {
- KALERT("%s - ktiva_recv_frame failed: %d\n", __FUNCTION__, ret);
- }
- }
- else
- {
- KALERT("%s - ktiva_send_frame failed: %d!\n", __FUNCTION__, ret);
- }
- return ret;
- }
- /////////////////////////////////////////////////////////////////////////////
- int TivaCmdGetUptime(struct file *pf, unsigned long long *put)
- {
- int ret;
- if(g_sw < 0x113)
- {
- #if _SUPPORT_LEGACY_UPTIME
- unsigned int ut;
- if((ret = TivaCmdGetAddress(pf, KTIVA_UPTIME_ADDRESS, &ut)) == 0)
- *put = ut;
- return ret;
- #else // _SUPPORT_LEGACY_UPTIME
- return -EPERM;
- #endif // _SUPPORT_LEGACY_UPTIME
- }
- #if _EXTENDED_ERROR_CHECK
- if(!put)
- {
- KALERT("%s: Invalid data pointer!\n", __FUNCTION__);
- return -EINVAL;
- }
- #endif // _EXTENDED_ERROR_CHECK
- if((ret = ktiva_send_frame(pf, COMMAND_GET_UPTIME, NULL, 0)) == 0)
- {
- unsigned long long data;
- if((ret = ktiva_recv_frame(pf, COMMAND_GET_UPTIME, &data, sizeof(data))) == sizeof(data))
- {
- *put = be64_to_cpu(data);
- kspi_tx_byte(pf, CMD_ACK);
- ret = 0;
- }
- else
- {
- KALERT("%s - ktiva_recv_frame failed: %d\n", __FUNCTION__, ret);
- }
- }
- else
- {
- KALERT("%s - ktiva_send_frame failed: %d!\n", __FUNCTION__, ret);
- }
- return ret;
- }
- /////////////////////////////////////////////////////////////////////////////
- int TivaCmdGetAddress(struct file *pf, unsigned int addr, unsigned int *val)
- {
- int ret;
- unsigned int data = cpu_to_be32(addr);
- #if _EXTENDED_ERROR_CHECK
- if(!val)
- {
- KALERT("%s: Invalid data pointer!\n", __FUNCTION__);
- return -EINVAL;
- }
- #endif // _EXTENDED_ERROR_CHECK
- if((ret = ktiva_send_frame(pf, COMMAND_GET_ADDR, &data, sizeof(data))) == sizeof(data))
- {
- if((ret = ktiva_recv_frame(pf, COMMAND_GET_ADDR, &data, sizeof(data))) == sizeof(data))
- {
- *val = be32_to_cpu(data);
- kspi_tx_byte(pf, CMD_ACK);
- ret = 0;
- }
- else
- {
- KALERT("%s - ktiva_recv_frame failed: %d\n", __FUNCTION__, ret);
- if(ret > 0)
- ret = -1;
- }
- }
- else
- {
- KALERT("%s - ktiva_send_frame failed: %d!\n", __FUNCTION__, ret);
- }
- return ret;
- }
- /////////////////////////////////////////////////////////////////////////////
- int TivaCmdSetAddress(struct file *pf, unsigned int addr, unsigned int val)
- {
- int ret;
- unsigned int data[2] = {cpu_to_be32(addr), cpu_to_be32(val)};
- if((ret = ktiva_send_frame(pf, COMMAND_SET_ADDR, &data, sizeof(data))) != sizeof(data))
- {
- KALERT("%s - ktiva_send_frame failed: %d!\n", __FUNCTION__, ret);
- if(ret > 0)
- ret = -1;
- }
- else
- {
- ret = 0;
- }
- return ret;
- }
- /////////////////////////////////////////////////////////////////////////////
- int TivaCmdPing(struct file *pf)
- {
- int ret;
- if((ret = ktiva_send_frame(pf, COMMAND_PING, NULL, 0)) != 0)
- {
- KALERT("%s - ktiva_send_frame failed: %d!\n", __FUNCTION__, ret);
- }
- return ret;
- }
- /////////////////////////////////////////////////////////////////////////////
- int TivaCmdGetStatus(struct file *pf, unsigned char *stat)
- {
- int ret;
- unsigned char data;
- #if _EXTENDED_ERROR_CHECK
- if(!stat)
- {
- KALERT("%s: Invalid data pointer!\n", __FUNCTION__);
- return -EINVAL;
- }
- #endif // _EXTENDED_ERROR_CHECK
- if((ret = ktiva_send_frame(pf, COMMAND_GET_STATUS, NULL, 0)) == 0)
- {
- if((ret = ktiva_recv_frame(pf, COMMAND_GET_STATUS, &data, sizeof(data))) == sizeof(data))
- {
- *stat = data;
- kspi_tx_byte(pf, CMD_ACK);
- ret = 0;
- }
- else
- {
- KALERT("%s - ktiva_recv_frame failed: %d\n", __FUNCTION__, ret);
- }
- }
- else
- {
- KALERT("%s - ktiva_send_frame failed: %d!\n", __FUNCTION__, ret);
- }
- return ret;
- }
- /////////////////////////////////////////////////////////////////////////////
- int TivaCmdGetBootloaderStatus(struct file *pf, unsigned char *stat)
- {
- int ret;
- unsigned char data;
- #if _EXTENDED_ERROR_CHECK
- if(!stat)
- {
- KALERT("%s: Invalid data pointer!\n", __FUNCTION__);
- return -EINVAL;
- }
- #endif // _EXTENDED_ERROR_CHECK
- if((ret = ktiva_send_frame(pf, COMMAND_GET_STATUS, NULL, 0)) == 0)
- {
- if((ret = ktiva_recv_bootloader_frame(pf, COMMAND_GET_STATUS, &data, sizeof(data))) == sizeof(data))
- {
- *stat = data;
- kspi_tx_byte(pf, CMD_ACK);
- ret = 0;
- }
- else
- {
- KALERT("%s - ktiva_recv_frame failed: %d\n", __FUNCTION__, ret);
- }
- }
- else
- {
- KALERT("%s - ktiva_send_frame failed: %d!\n", __FUNCTION__, ret);
- }
- return ret;
- }
- /////////////////////////////////////////////////////////////////////////////
- int TivaCmdStartBootloader(struct file *pf)
- {
- int ret;
- if((ret = ktiva_send_frame(pf, COMMAND_START_BOOTLOADER, NULL, 0)) != 0)
- {
- KALERT("%s - ktiva_send_frame failed: %d!\n", __FUNCTION__, ret);
- }
- return ret;
- }
- /////////////////////////////////////////////////////////////////////////////
- int TivaCmdStartDownload(struct file *pf, unsigned int addr, size_t size)
- {
- int ret;
- unsigned int data[2] = {cpu_to_be32(addr), cpu_to_be32((unsigned int)size)};
- KALERT("%s: Addr.: 0x%08X, CB: %zu!\n", __FUNCTION__, addr, size);
- if((ret = ktiva_send_frame(pf, COMMAND_DOWNLOAD, data, sizeof(data))) == sizeof(data))
- {
- ret = 0;
- }
- else
- {
- KALERT("%s - ktiva_send_frame failed: %d!\n", __FUNCTION__, ret);
- }
- return ret;
- }
- /////////////////////////////////////////////////////////////////////////////
- int TivaCmdSendDataBlock(struct file *pf, const void *pBlock, size_t nCbBlock)
- {
- int ret;
- // KALERT("%s: Data: 0x%p, CB: %zu!\n", __FUNCTION__, pBlock, nCbBlock);
- if((ret = ktiva_send_frame(pf, COMMAND_SEND_DATA, pBlock, nCbBlock)) == nCbBlock)
- {
- ret = 0;
- }
- else
- {
- KALERT("%s - ktiva_send_frame failed: %d!\n", __FUNCTION__, ret);
- }
- return ret;
- }
- /////////////////////////////////////////////////////////////////////////////
- int TivaCmdReset(struct file *pf)
- {
- int ret;
- if((ret = ktiva_send_frame(pf, COMMAND_RESET, NULL, 0)) != 0)
- {
- KALERT("%s - ktiva_send_frame failed: %d!\n", __FUNCTION__, ret);
- }
- return ret;
- }
- /////////////////////////////////////////////////////////////////////////////
- int TivaCmdGetMatSer(struct file *pf, LPTIVA_MAT_SER pms)
- {
- int ret;
- TIVA_MAT_SER data;
- #if _EXTENDED_ERROR_CHECK
- if(!pms)
- {
- KALERT("%s: Invalid data pointer!\n", __FUNCTION__);
- return -EINVAL;
- }
- #endif // _EXTENDED_ERROR_CHECK
- if((ret = ktiva_send_frame(pf, COMMAND_GET_MAT_SER, NULL, 0)) == 0)
- {
- if((ret = ktiva_recv_bootloader_frame(pf, COMMAND_GET_MAT_SER, &data, sizeof(data))) == sizeof(data))
- {
- memcpy(pms, &data, sizeof(data));
- kspi_tx_byte(pf, CMD_ACK);
- ret = 0;
- }
- else
- {
- KALERT("%s - ktiva_recv_frame failed: %d\n", __FUNCTION__, ret);
- }
- }
- else
- {
- KALERT("%s - ktiva_send_frame failed: %d!\n", __FUNCTION__, ret);
- }
- return ret;
- }
- /////////////////////////////////////////////////////////////////////////////
- int TivaCmdSetBacklight(struct file *pf, unsigned int nPeriod, unsigned int nDutyCyclePerc)
- {
- int ret;
- unsigned int data[2] =
- {
- cpu_to_be32(nPeriod),
- cpu_to_be32(_ScaleDutyCycle(nPeriod, nDutyCyclePerc))
- };
- if((ret = ktiva_send_frame(pf, COMMAND_SET_BACKLIGHT, data, sizeof(data))) == sizeof(data))
- {
- ret = 0;
- }
- else
- {
- KALERT("%s - ktiva_send_frame failed: %d!\n", __FUNCTION__, ret);
- }
- return ret;
- }
- /////////////////////////////////////////////////////////////////////////////
- int TivaCmdGetI2C(struct file *pf, unsigned char nI2CAddr, unsigned char nI2CStart, size_t nCbI2C, void *pData, size_t nCbData)
- {
- int ret;
- unsigned char data[3] =
- {
- nI2CAddr,
- nI2CStart,
- (unsigned char)nCbI2C
- };
- #if _EXTENDED_ERROR_CHECK
- if(!pData)
- {
- KALERT("%s: Invalid data pointer!\n", __FUNCTION__);
- return -EINVAL;
- }
- #endif // _EXTENDED_ERROR_CHECK
- if((ret = ktiva_send_frame(pf, COMMAND_GET_I2C, data, sizeof(data))) == sizeof(data))
- {
- if((ret = ktiva_recv_frame(pf, COMMAND_GET_I2C, pData, nCbData)) == nCbData)
- {
- kspi_tx_byte(pf, CMD_ACK);
- ret = 0;
- }
- else
- {
- KALERT("%s - ktiva_recv_frame failed: %d!\n", __FUNCTION__, ret);
- }
- }
- else
- {
- KALERT("%s - ktiva_send_frame failed: %d!\n", __FUNCTION__, ret);
- }
- return ret;
- }
- /////////////////////////////////////////////////////////////////////////////
- int TivaCmdSetI2C(struct file *pf, unsigned char nI2CAddr, unsigned char nI2CStart, const void *pData, size_t nCbData)
- {
- int ret;
- size_t nLen = 3;
- unsigned char data[512] =
- {
- nI2CAddr,
- nI2CStart,
- (unsigned char)nCbData
- };
- #if _EXTENDED_ERROR_CHECK
- if(!pData)
- {
- KALERT("%s: Invalid data pointer!\n", __FUNCTION__);
- return -EINVAL;
- }
- #endif // _EXTENDED_ERROR_CHECK
- if((nLen + nCbData) > sizeof(data))
- {
- KALERT("%s: Invalid data size: %zu!\n", __FUNCTION__, nCbData);
- return -EINVAL;
- }
-
- memcpy(&data[3], pData, nCbData);
- nLen += nCbData;
- if((ret = ktiva_send_frame(pf, COMMAND_PUT_I2C, data, nLen)) == nLen)
- {
- ret = 0;
- }
- else
- {
- KALERT("%s - ktiva_send_frame failed: %d!\n", __FUNCTION__, ret);
- }
- return ret;
- }
|