#define UBX_STS_SUMB 8
/*
- len: payload length
+ * lenp: payload length
*/
static void ublox_make_sum(unsigned char *pkt, unsigned int lenp, unsigned char *suma, unsigned char *sumb)
{
}
/*
* GPSに送信するコマンドパケットの作成
- * unsgined char len: payloadのバイト数
+ * unsgined char lenp: payloadのバイト数
* return: 作成したパケットpktのバイト数
*/
int ublox_make_cmd(unsigned char id1, unsigned char id2, unsigned int lenp, unsigned char *payload, unsigned char pkt[])
payload[4] = 50; // cable delay ns
-// payload[8] = 0x80; // Freq 10MHz
-// payload[9] = 0x96;
-// payload[10] = 0x98;
-// payload[11] = 0x00;
-
payload[8] = 0x00; // Freq 7.372800MHz
payload[9] = 0x80;
payload[10] = 0x70;
payload[11] = 0x00;
-// payload[12] = 0x80; // Freq locked 10MHz
-// payload[13] = 0x96;
-// payload[14] = 0x98;
-// payload[15] = 0x00;
-
payload[12] = 0x00; // Freq locked 7.372800MHz
payload[13] = 0x80;
payload[14] = 0x70;
payload[4] = 50; // cable delay ns
- payload[8] = 0x40; // Period us
+ payload[8] = 0x40; // Period 1,000,000us
payload[9] = 0x42;
payload[10] = 0x0F;
payload[11] = 0x00;
payload[14] = 0x0F;
payload[15] = 0x00;
- payload[16] = 0x00; // Pulse width us
- payload[17] = 0x00;
- payload[18] = 0x00;
+ payload[16] = 0x20; // Pulse width 500,000us
+ payload[17] = 0xA1;
+ payload[18] = 0x07;
payload[19] = 0x00;
-// payload[20] = 0xA0; // Pulse width locked 100,000us
-// payload[21] = 0x86;
-// payload[22] = 0x01;
-// payload[23] = 0x00;
-
- payload[20] = 0x20; // Pulse width locked 500,000us
- payload[21] = 0xA1;
- payload[22] = 0x07;
- payload[23] = 0x00;
-
- payload[20] = 0x00; // Pulse width locked 800,000us
- payload[21] = 0x35;
- payload[22] = 0x0C;
+ payload[20] = 0xA0; // Pulse width locked 100,000us
+ payload[21] = 0x86;
+ payload[22] = 0x01;
payload[23] = 0x00;
-
payload[28] = 0b11110111; // Grid=GPS,Pol=Rise
len_pkt = ublox_make_cmd(UBX_CLS_CFG, UBX_ID_CFG_TP5, lenp, payload, pkt);
ublox_rcv_pkt(&class, &id, &len, payload);
if (class == 0x05 && id == 0x01) {
// ACK
- PDEBUG("ACK\r\n");
+// PDEBUG("ACK\r\n");
return 1;
} else if (class == 0x05 && id == 0x00) {
// NACK
- PDEBUG("NACK\r\n");
+// PDEBUG("NACK\r\n");
return 0;
}
}